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Abstract 

The  reduction  of  the  navigation  error  in  an  inertial  navigation  system  by  optically 
tracking  a  ground  object  is  investigated.  Multiple  observations  of  the  ground  object  are 
used.  The  location  of  the  ground  object  is  assumed  unknown.  A  careful  analysis  of  the 
measurement  situation  at  hand  reveals  that  by  optically  tracking  an  unknown  ground  ob¬ 
ject  using  passive,  bearings-only  measurements,  the  aircraft’s  angle  of  attack  and  sideslip 
angle  can  be  measured.  Thus,  two  new  independent  measurement  equations  featuring  the 
aircraft’s  angular  navigation  variables  roll,  pitch,  yaw  angles,  V',  0,  4>,  and  flight  path  angle 
7  and  heading  H  are  obtained.  Hence,  by  optically  tracking  over  time  an  unknown  ground 
object,  inertial  navigation  system  aiding  is  in  fact  possible.  Moreover,  the  estimation  algo¬ 
rithm,  which  operates  on  the  bearing  measurements  record,  simultaneously,  and  in  parallel, 
produces  corrections  required  for  both  inertial  navigation  system  aiding  and  geo-location 
of  the  ground  object.  Eurthermore,  the  theory  developed  in  this  paper  is  easily  adapted 
to  accommodate  additional  measurements  and/or  prior  information.  The  former  entail 
range  measurements,  and  prior  information  entails  some,  or  all,  position  coordinates  of 
the  ground  object.  These  enhancements  reflect  the  current  operational  practice.  Thus, 
the  theory  presented  in  this  paper  is  sufficiently  general  to  encompass  the  conventional 
methods  of  inertial  navigation  system  updating  in  which  both  bearing  and  range  measure¬ 
ments  are  used  and  the  coordinates  of  the  ground  object  are  known.  In  all  cases  in  which 
additional  independent  measurements  and/or  prior  information  are  used,  the  accuracy  of 
both  the  navigation  solution  and  the  geo-location  are  enhanced. 


INS  AIDING  BY  TRACKING  AN 
UNKNOWN  GROUND  OBJECT 


I.  Introduction 


1 . 1  Introduction 

Determining  a  vehicle’s  position  and  velocity  by  measuring  its  acceleration  and  pro¬ 
cessing  the  acceleration  information  in  a  computer  is  one  of  the  many  definitions  for  inertial 
navigation  [4],  An  Inertial  Navigation  System{INS)  is  a  self-contained  and  autonomous 
method  of  navigation.  It  is  self-contained  because  acceleration  and  angular  rate  infor¬ 
mation  necessary  for  navigation  are  measured  by  built-in  accelerometers  and  gyroscopes, 
which  are  non-radiating  and  non-jammable.  It  is  autonomous,  because  all  the  required 
information  is  obtainable  at  all  latitudes,  in  all  weather  and  even  without  the  aid  of  any 
external  source.  From  this  point  of  view,  INS  is  the  most  favorable  means  of  navigation. 
Unfortunately,  INS  suffers  from  drifi  the  degradation  of  accuracy  in  position,  velocity  and 
attitude  information.  As  a  result,  the  accuracy  of  the  INS  deteriorates  over  time;  therefore, 
it  needs  to  be  updated  periodically. 

In  a  simple  way,  position  errors  caused  by  drift  can  be  corrected  by  resetting  the 
position  to  the  coordinates  of  a  point  which  is  observable  by  the  pilot  on  the  surface  of  the 
earth.  These  corrections  either  require  the  use  of  aetive  systems  which  transmit  electro¬ 
magnetic  signals  causing  the  presence  of  the  aircraft  to  be  revealed,  or  on  enemy  territory, 
the  coordinates  of  the  point  required  for  correction  may  not  be  available  -  or  may  be 
inaccurate  [4]. 


An  inertial  system  periodically  corrected  with  external  position  measurements 
will  have  bounded  errors  in  all  the  navigation  variables.  But,  such  a  system 
is  obviously  not  autonomous  and  is  subjected  to  intentional  or  unintentional 
denial,  which  is  unattractive  in  military  applications [4] 
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1.2  Problem 


In  this  research,  the  possible  reduction  of  the  navigation  error  in  an  inertial  system 
by  tracking  a  ground  object  is  addressed.  Particularly,  in  an  environment  a  GPS  outage 
is  expected,  by  optically  tracking  an  unknown  ground  object,  INS  is  tried  to  be  updated. 
Tracking  will  be  provided  by  passive,  bearing-only  measurements. 

1.3  Summary  of  Current  Knowledge 

1.3.1  Inertial  Navigation  System.  The  operation  of  inertial  navigation 
systems  depend  on  the  laws  of  classical  mechanics  as  formulated  by  Newton.  Newton’s 
laws  can  be  described  as  follows.  “The  motion  of  a  body  is  maintained  unless  disturbed  by 
an  other  force”.  This  force  produces  a  proportional  acceleration  of  the  body.  Measuring 
that  acceleration,  it  is  possible  to  calculate  the  change  in  velocity  and  position  of  the 
body  by  successive  integration  of  the  acceleration  with  respect  to  time.  Acceleration 
is  measured  by  the  accelerometers.  Each  for  obtaining  acceleration  measurement  in  a 
single  direction,  an  inertial  system  contains  three  such  devices  whose  sensitive  axes  are 
constructed  perpendicular  each  other. 

Gyroscopes  are  used  to  determine  the  orientation  of  accelerometers  in  the  inertial 
reference  frame.  Measured  inertial  acceleration  is  resolved  into  the  local  reference  frame  by 
using  the  orientation  information.  By  so  doing,  the  direction  of  which  the  accelerometers 
are  pointing  is  determined. 

Inertial  navigation  system  combines  the  two  sets  of  measurements  provided  by  the 
accelerometers  and  gyroscopes  to  determine  the  velocity  and  position  of  the  vehicle  within 
the  inertial  reference  frame.  Unlike  many  others  types  of  navigation  system,  inertial  sys¬ 
tems  are  self-contained.  Required  measurements  for  the  navigation  are  obtained  without 
use  of  any  external  source.  Nevertheless,  inertial  systems  rely  on  the  availability  of  the 
accurate  knowledge  of  the  vehicle  position  at  the  start  of  navigation  [8]. 

1.3.2  Aided  INS  Concept.  Aided  inertial  navigation  is  a  method  to  reduce 
the  INS  errors,  in  particular  the  position  error  drift,  and  to  align  the  INS  or  improve  its 
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alignment  while  moving.  Other  navigation  sensors  that  measures  the  position,  velocity  and 
orientation  provide  the  INS  aiding  data.  A  Kalman  filter  performs  the  integration  of  the 
INS  and  aiding  navigation  data.  The  Kalman  filter  estimates  the  INS  and  aiding  sensor 
errors  based  on  the  navigation  data  presented,  and  then  corrects  the  INS  navigation  errors 
based  on  the  estimated  errors.  This  closed  loop  INS  error  reduction  algorithm  is  known  as 
INS  aiding  [2]. 

1.3.3  Position  Updates  by  INS  Fix-Taking.  The  INS  estimate  of 
present  position  can  be  updated  either  via  use  of  a  radar  or  by  overflying  a  known  point. 
INS  in-flight  updating  in  third  generation  fighter  aircraft  is  currently  performed  by  using 
the  following  fix  modes  [6] : 

1.  Radar  fix  update 

2.  Head  Up  Display  (HUD)  fix  update 

3.  Overfly  (OFLY)  fix  update 

4.  Targeting  pod  fix  updates 

In  all  the  modes  above,  the  position  of  the  ground  object  is  assumed  to  be  known,  and  to 
have  been  stored  in  the  on-board  computer  before  the  flight.  Inertial  positioning  errors  of 
the  master  navigation  filter  result  in  an  initial  mis-location;  to  correct  the  error,  the  radar 
ground  map  or  radar  air-to-ground  ranging  (Head  Up  Display  (HUD)  sighting)  sensor 
modes  can  be  used  [6] . 

1.3.4  Position  Updates  by  Passive  Measurements.  Currently,  there 
is  not  any  applications  or  research  focused  on  INS  aiding  by  using  passive  measurements  on 
an  unknown  ground  object.  Some  ideas  had  been  produced,  but  have  not  been  implemented. 

One  of  the  related  ideas  was  the  INS  aiding  by  using  bearings’  measurements  from 
an  unknown  (lunar)  landmark.  The  idea  was  first  suggested  for  [7]  space  navigation  re¬ 
search  of  Apollo  Mission.  “During  the  orbital  and  mid-course  phase  of  a  space  mission, 
inertial  measurements  no  longer  provide  information  about  the  position  of  the  vehicle  due 
to  the  lack  of  force  [7]”.  Therefore,  the  navigation  system  needs  external  sensors  and 
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measurements  to  update  the  position  information  within  the  vehicle.  Optical  bearing 
measurements  by  tracking  an  unknown  landmark  is  one  of  the  possible  measurements  that 
have  been  considered. 

1.3.5  Optical  Flow.  The  formulation  of  the  tracking  problem  is  driven  by 
the  need  to  maintain  the  non-radiating  capability  of  the  INS  when  tracking  an  unknown 
ground  object.  Thus,  passive,  bearing-only  measurements  of  the  ground  object  should 
be  used.  These  measurements  can  be  provided  by  an  optical  tracker  or  an  electo-optical 
tracker.  The  assumption  the  position  of  the  ground  object  is  not  known  will  essentially 
introduce  the  measurements  of  optical  flow. 

In  this  research,  we  confine  our  attention  to  the  optical  measurements  obtained  from 
tracking  of  a  ground  object.  We  assume  that  there  are  low  intensity  variations  in  the 
observed  scene.  In  this  case  a  human  operator  is  needed  to  close  the  optical  tracking 
loop,  similar  to  the  use  of  a  driftmeter[9].  Furthermore,  INS-aiding  using  measurements 
on  a  ground  object  is  intimately  related  to  the  problem  of  geo-location.  The  latter  entails 
the  estimation  of  the  a  priori  information  for  the  unknown  position  of  the  ground  object 
from  measurements  taken  by  the  aircraft.  In  this  case,  the  estimation  of  the  ground 
object’s  position  relies  on  the  accuracy  of  aircraft  current  position  and  attitude  knowledge. 
It  is  obvious  that  these  navigational  errors  are  reflected  in  the  ground  object’s  position 
estimate.  Conversely,  in  conventional  INS-aiding,  it  is  usually  assumed  that  the  position 
of  the  ground  object  is  known,  and  range  and  bearing  measurements  are  used  to  obtain  an 
independent  position  estimate  of  the  aircraft.  Hence,  INS-aiding  and  geo- location  appear 
to  be  on  the  opposite  sides  of  the  same  situations. 

1.4  Scope 

In  this  research  we  assume  that  the  position  of  the  ground  object  is  not  known.  Also, 
we  initially  remove  the  requirement  of  range  measurements  and  we  exclusively  rely  on 
bearings-only  measurements,  however,  we  use  multiple  observations  of  the  ground  object. 
Hence,  we  consider  an  austere  geo-location  type  scenario  and  we  will  show  that  INS-aiding 
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is,  in  fact,  possible.  In  addition,  and  as  expected,  we  will  show  that  geo-location  is  also 
possible. 


1.5  Approach/ Methodology 

The  research  presented  herein  starts  by  the  careful  analysis  of  the  measurement 
situation  at  hand.  In  the  analysis,  we  develop  two  hypotheses:  while  the  first  hypothesis 
claims  that  the  aircraft  angle  of  attack  (AOA)  and  drift  angle  could  be  obtained  by  optically 
tracking  an  unknown  object,  the  second  claims  that  the  AOA  and  drift  angle  yield  two 
new  independent  measurement  equations  featuring  the  aircraft’s  navigation  variables  roll, 
pitch,  yaw  angles,  9,  (j),  and  flight  path  angle  7  and  the  heading  H.  Modelling  of  the 
measurement  situation  follows  the  validation  of  these  two  hypotheses. 

Next,  we  develop  the  Minimum  Variance  Estimation  formulae  based  on  the  suggested 
measurement  situation  model.  By  incorporating  bearing-only  measurements,  INS-aiding  is 
mathematically  discussed.  Investigating  different  scenarios,  it  is  shown  that  one  can  per¬ 
form  INS  aiding  by  tracking  an  unknown  object  by  means  of  LOS  measurements  only.  The 
theoretical  framework  developed  in  this  research,  however,  can  be  easily  adapted  to  accom¬ 
modate  additional  measurements  and/or  a  priori  information.  Additional  measurements 
would  entail  range  measurements  and/or  range  rate  measurements;  and  prior  information 
would  entail  some,  or  all,  position  coordinates  of  the  ground  object.  These  enhancements 
would  reflect  the  current  operational  practice.  Thus,  the  theory  presented  in  this  research  is 
sufficiently  general  to  encompass  the  conventional  methods  of  INS  updating  in  which  both 
bearing  and  range  measurements  are  used  and  the  coordinates  of  the  ground  object  are 
known.  In  all  cases  where  additional  independent  measurements  and/or  prior  information 
are  used,  the  accuracy  of  the  navigation  solution  is  enhanced. 

Furthermore,  we  show  that  the  geo-location  is  possible,  too.  Using  a  ground  object 
for  INS  aiding  to  improve  one’s  position  estimate  and  then  performing  a  geo-location  of  the 
same  ground  object  by  using  just  aided  INS  information  is  an  illusion.  This  is  not  the  case, 
and  in  fact,  the  algorithm  which  operates  on  the  bearing  measurements  simultaneously, 
and  in  parallel,  produces  corrections  required  for  both  INS  update  and  geo-location. 
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Based  on  the  physical  insight  gained  from  the  theory,  the  estimation  algorithms 
are  developed.  In  the  algorithms,  bearing-only  measurements  and  INS  provided  inertial 
measurements  are  optimally  weighted  in  a  Bayesian  formulation,  using  their  respective 
parameter  estimation  error  covariances. 

Finally,  simulation  experiments  are  performed  to  validate  the  novel  navigation  con¬ 
cept.  Concluding  remarks  are  made  at  the  end  of  the  research,  including  that  INS  error 
reduction  by  tracking  an  unknown  ground  object  via  bearing-only  measurements  is  partly 
possible. 

1 . 6  Summary 

In  this  section,  we  presented  an  introduction  for  the  research  about  INS  aiding  by 
tracking  an  unknown  ground  object.  After  a  brief  summary  of  the  current  knowledge,  we 
defined  the  scope  of  the  research.  Next,  approach  and  methodology  were  explained  shortly. 
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II,  Literature  Review 


2. 1  Introduction 

^^INS  is  the  KingP'  says  a  leading  professor  from  the  AFIT  Guidance,  Navigation  & 
Control  research  group.  Surely,  you  are  asking  yourselves  why  is  this  so  ? 

Determining  a  vehicle’s  position  and  velocity  by  measuring  its  acceleration  and  pro¬ 
cessing  the  acceleration  information  in  a  computer  is  one  of  the  many  definitions  for  inertial 
navigation[^.  Among  the  several  methods  of  navigation,  the  inertial  navigator,  namely 
the  Inertial  Navigation  System  (INS),  is  a  self-contained  and  autonomous  one.  It  is  self- 
contained  because  acceleration  and  angular  rate  information  necessary  for  navigation  are 
measured  by  built-in  accelerometers  and  gyroscopes,  which  are  non-radiating  and  non- 
jammable.  It  is  autonomous,  because  all  the  required  information  is  obtainable  at  all 
latitudes,  in  all  weather  and  even  without  the  aid  of  any  external  source.  Thus,  the  claim 
that  “INS  is  the  King!”  is  not  a  poor  analogy. 

Unfortunately,  the  King  suffers  from  drift,  degradation  of  accuracy  in  position  and 
velocity  information  obtained  autonomously  and  inclusively.  As  a  result,  the  accuracy  of 
the  INS  deteriorates  over  time;  therefore,  it  needs  to  be  updated  periodically;  that  is,  the 
King  asks  for  an  advisor  occasionally. 

Much  research  on  the  INS  aiding  concept  exists  in  the  literature.  It  includes  not 
only  inventions  of  practical  solutions  but  also  considerable  research  aiming  to  enhance 
degraded  INS  accuracy.  INS  aiding  by  traeking  ground  objeets  is  among  the  most  popular 
areas  studied.  However,  little  research  into  INS  aiding  by  tracking  an  unknown  ground 
object  exists.  A  few  suggestions  have  been  made  on  this  but  they  have  not  gone  beyond 
theory.  In  this  thesis,  we  will  investigate  the  possible  reduction  of  the  navigation  error  of 
an  inertial  system  by  tracking  a  ground  object.  In  particular,  the  ground  object  will  be 
assumed  unknown  and  tracking  will  be  provided  by  passive,  bearing-only  measurements. 
Although  not  exactly  related  to  unknown  ground  object  tracking,  various  basic  research 
publications  on  INS  aiding  are  available  in  the  open  literature.  Thus,  the  basic  objective  of 


2-1 


this  review  is  to  comb  the  literature  for  background  information  clarifying  the  problem  at 
hand  and  providing  information  that  might  help  produce  a  related  theory  for  the  solution. 

Appropriate  for  this  problem,  eight  articles  have  been  covered  in  this  literature  re¬ 
view,  and  it  is  organized  into  three  sections.  In  the  first  section,  background  information 
is  presented.  Definition  of  the  inertial  system  and  the  concept  introducing  INS  aiding  are 
the  first  two  topics  in  the  background.  The  next  two  topics  describe  the  methods  used  in 
aiding.  In  the  second  section,  four  topics  are  reviewed.  Optical  Measurements  and  Naviga¬ 
tion  Phenomena  is  particularly  relevant  to  the  problem.  Here,  a  theory  suggested  for  the 
Apollo  Mission  is  studied  explicitly.  The  following  three  topics  cover  autonomy  of  the  INS 
that  motivates  the  research,  optical  flow  and  driftmeter.  The  last  two  are  the  significant 
tools  for  the  research  validity.  A  conclusion  in  the  third  section  summarizes  the  problem 
and  concludes  that  a  solution  is  achievable. 

This  literature  review  gives  only  a  glimpse  into  the  problem  at  hand.  The  most 
significant  work  will  be  to  produce  the  theory  for  the  solution  of  the  problem  and  to 
validate  it. 


2.2  Background 

2.2.1  Inertial  Navigation  System.  Inertial  navigation  systems  use  mea¬ 
surements  obtained  from  the  accelerometers  and  gyroscopes  mounted  on  a  platform  whose 
angular  velocity  either  is  controlled  (as  with  gyro  stabilized  gimballed  platforms)  or  is 
measured  (as  with  strapdown  systems)  to  provide  position,  velocity,  and  attitude  infor¬ 
mation  of  the  aircraft.  In  all  INS  implementations,  it  is  an  unavoidable  fact  that  altitude 
and  vertical  velocity  computation  is  unstable  (assuming  gravity  magnitude  is  computed  as 
a  function  of  the  indicated  altitude).  The  time  constant  of  the  exponential  instability  is 
about  10  minutes.  Some  external  altitude  reference  must  be  incorporated  into  the  vertical 
channel  measurements  for  typical  navigation  durations  (an  hour  or  more)  to  alleviate  the 
errors  caused  by  this  instability  [10]. 

Other  than  the  vertical  channel  instabilities,  however,  there  are  additional  errors 
inherent  to  the  design  of  inertial  navigation  systems  that  cause  a  drift  in  INS  position. 
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velocity,  and  attitude  outputs.  These  errors  result  from  the  imperfection  of  the  inertial 
sensors  which  contain  built-in  errors.  A  medium  quality  INS  contains  ring-laser-gyros 
(RLG)  with  less  than  0.01  degrees/hour  bias  and  pendulous  servo  accelerometers  with  less 
than  50  micro-g’s  bias,  and  exhibits  a  typical  position  error  rate  of  1  nm/hour  [2].  Al¬ 
though  these  inertial  drift  rate  errors  are  small  and  acceptable  for  A/C  navigation  initially, 
they  become  larger  and  larger  with  time  unless  they  are  corrected  by  more  accurate  and 
independent  measurements  [11].  This  phenomenon  also  introduces  the  aided  INS  concept. 

2.2.2  Aided  INS  Concept.  The  performance  of  an  inertial  system  is 
characterized  by  a  time  dependent  drift  in  the  accuracy  of  the  position  estimates  it  provides. 
The  rate  of  the  growing  error  depends  basically  on  the  accuracy  of  the  initial  alignment, 
inertial  sensor  imperfections,  and  the  dynamics  of  the  trajectory  of  the  host  vehicle.  While 
improvements  in  accuracy  can  be  obtained  through  the  use  of  more  accurate  and  higher 
quality  sensors,  there  are  limits  to  the  performance  which  can  reasonably  be  achieved 
before  the  cost  of  the  inertial  system  becomes  too  great  to  be  affordable. 

An  alternative  approach,  suitable  for  many  implementations,  can  be  devising  some 
additional  navigation  sources  different  than  those  the  inertial  system  provides,  to  improve 
the  accuracy:  in  other  words,  an  aided  inertial  system.  In  an  aided  inertial  system,  one 
or  more  of  the  inertial  measurements  is  compared  to  the  identical  measurements  obtained 
from  the  external  sources.  The  corrections  are  applied  to  the  system  based  on  these 
differences.  The  optimal  combination  of  these  differences  and  inertial  measurements  yields 
more  accurate  navigation  solutions  than  the  inertial  system  would  provide  alone. 

Basically,  the  various  types  of  navigation  aids  may  be  introduced  in  two  classes: 
External  measurements  are  acquired  by  receiving  signals  outside  the  vehicle.  The  required 
data  can  be  transmitted  to  the  vehicle  during  the  navigation  or  there  will  be  a  receiver 
onboard  to  acquire  the  observations.  This  class  of  navigation  aids  usually  provide  a  position 
fix  which  may  be  expressed  as  co-ordinates  with  respect  to  local  reference  frame.  Radio 
navigation  aids  such  as  Tactical  Air  Navigation  System  (TAG AN),  Very  high  frequency 
Omni-directional  radio  Range  (VOR),  Distance  Measuring  Equipment  (DME),  and  Global 
Positioning  System  (GPS),  star-trackers  or  a  ground  based  radar  trackers  are  examples  of 
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this  class  of  navigation  aid. 

Onboard  measurements  are  obtained,  as  the  name  indicates,  by  using  onboard  sensors  such 
as  the  altimeter,  aircraft’s  radar,  airspeed  indicator,  magnetic  sensors,  and  infra-red  or 
electro-optical  imaging  systems.  Such  sensors  can  be  used  to  provide  attitude,  velocity  or 
position  updates  [8]. 

2.2.3  Position  Updates  Of  An  Inertial  System.  In  a  simple  way, 
position  errors  caused  by  drift  can  be  corrected  by  resetting  the  position  to  the  coordinates 
of  a  point  which  is  observable  by  the  pilot  on  the  surface  of  the  earth.  Designing  fixed 
gain  mechanizations  to  feed  back  the  observed  position  differences  between  the  INS  and 
the  reference  measurements  to  correct  the  sources  of  these  errors  has  been  inconvenient 
due  to  time-varying  error  dynamics  associated  with  the  inertial  system.  However,  this 
problem  was  diminished  with  the  development  of  recursive  filtering  by  R.  E.  Kalman  in 
1960,  and  the  powerful  digital  computers  made  possible  algorithm  mechanizations.  With 
Kalman  filtering  theory,  gains  are  weighted  based  on  the  error  covariance  instead  of  fixed 
gains.  Error  corrections  through  the  use  of  such  gains  provide  optimal  minimization  of  the 
existing  errors  [4]. 

2.2.4  INS  Position  Updates  by  Fix- Taking.  INS  position  updates  by 
fix-taking  subject  addressed  below  is  based  on  my  knowledge  as  a  pilot  and  the  reference 
[6].  The  INS  estimate  of  present  position  can  be  updated  either  via  use  of  the  radar  or 
by  overflying  a  known  point.  The  radar  ground  map  or  radar  air-to-ground  ranging  (HUD 
sighting)  sensor  modes  can  be  used  to  update  position.  The  basic  geometry  of  these  fix 
modes  is  depicted  as  follows. 

1.  Radar  fix  update:  The  multifunctional  display  provides  a  radar  image  of  the  ground. 
System  solution  indicates  the  ground  object  based  on  the  pre-determined  and  stored 
coordinates.  The  pilot  makes  a  manual  correction  by  slewing  and  placing  the  big 
cross  on  the  true  aim-point  location.  This  registers  the  range  to  the  ground  object 
and  depressions  and  bearing  angles  of  the  ground  object  with  central  navigation 
Kalman  filter. 
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2.  Head  Up  Display  (HUD)  fix  update:  HUD,  located  on  the  center  of  the  glare  shield 
at  the  eye-level  of  the  pilot,  provides  a  visual  reference  by  locating  a  diamond  on 
the  ground  object  based  on  the  pre-determined  and  stored  coordinates.  The  pilot 
indicates  the  true  aim-point  location  by  slewing  the  diamond  onto  target  location. 
An  air-to-ground  ranging  mechanism  provides  range  information  and  the  bearing  and 
depression  angles  are  registered  with  the  central  navigation  Kalman  filter. 

3.  Overfly  (OFLY)  fix  update:  The  pilot  overflies  a  pre-determined  landmark  for  which 
coordinates  have  been  stored  as  a  steering  point  (STPT)  or  an  Initial  Point  (IP)  and, 
at  the  pilot’s  cue,  its  observed  position  is  sent  to  the  central  navigation  Kalman  filter 
to  provide  correction. 

4.  Targeting  pod  fix  updates:  The  pilot  updates  the  master  navigation  filter  by  using 
Forward  Looking  Infra  Red  (FLIR)  or  Down  Looking  Infra  Red  (DLIR)  video  for 
sightings  on  known  ground  object.  The  pod  cursor  is  initially  pointed  at  the  esti¬ 
mated  position  of  the  ground  object,  based  on  the  stored  coordinates  of  the  ground 
object,  its  elevation,  and  the  navigation  system’s  estimation  of  present  position,  alti¬ 
tude,  and  attitude  of  the  aircraft.  The  pilot  manually  applies  the  correction  by  mov¬ 
ing  the  cursor  to  the  ground  object,  thus  nullifying  the  pointing  error.  By  pulling  the 
trigger  on  the  stick,  a  laser  range  measurement  can  be  obtained  as  well.  Moreover, 
the  pilot  can  get  a  laser  lock  to  ground  object,  provided  the  contrast  is  sufficiently 
high. 

In  all  scenarios  above,  the  position  of  the  ground  object  is  assumed  to  be  known,  and  to 
have  been  stored  in  the  on-board  computer  before  the  flight.  Inertial  positioning  errors 
of  the  master  navigation  filter  result  in  an  initial  mis-location  of  the  big  cross  in  (1),  the 
diamond  in  (2),  or  the  cursor  in  (4)  by  the  amount  of  error.  This  initial  placement  error 
is  displayed  in  Data  Entry  Device  (DED)  and  the  pilot  manually  applies  the  correction. 

2.3  The  Possible  Solution 

2.3.1  Optical  Measurements  and  Navigation  Phenomena.  The 

idea  of  INS  aiding  by  using  bearings  measurements  on  unknown  (lunar)  landmark  was 
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first  suggested  in  [7]  space  navigation  research  associated  with  the  Apollo  Mission.  Optical 
bearing  measurements  by  tracking  an  unknown  landmark  was  considered  to  aid  the  inertial 
system.  Different  from  the  conventional  means  of  obtaining  inertial  measurements,  the 
navigational  system  is  obliged  to  use  the  changes  in  the  tracking  angle  as  the  vehicle 
passes  over  a  landmark,  especially  when  the  landmark  has  unknown  coordinates. 

Let’s  assume  that  the  astronaut  is  able  to  lock  onto  an  identifiable  but  unknown  point 
on  the  earth’s  surface.  Figure  2.1  describes  the  measurement  geometry.  The  problem  here 


ACQUSATION  TRACKING  POINTS 


Figure  2.1  Nominal  tracking  sequence. 


is  to  determine  the  errors  at  the  acquisition  point.  Also  assume  that  Hq  is  the  height  of  the 
velocity  vector,  ro  is  the  distance  travelled  for  some  time  r,  and  loq  is  the  angular  velocity 
of  the  vehicle  (see  Figure  2.1).  In  this  situation,  the  computed  bearing  measurements  is 
given  by: 


So  -  roLVoT 
cot  OLc  —  — 

tia 


(2.1) 


The  suggested  idea  is  investigated  in  Appendix  A  in  detail.  The  measurement  situation  is 
very  similar  to  our  problem,  and  can  be  used  as  a  point  of  departure  for  the  development 
of  algorithm  concerning  optical  tracking  of  a  ground  object. 


2.3.2  About  The  Autonomy  of  INS.  Autonomy  represents  the  ability  of 
a  system  to  determine  its  position  and  velocity  on  by  own,  without  external  navigation  aids. 
Autonomy  has  a  great  significance  for  military  vehicles  operating  on  the  enemy  territories 
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or  in  the  areas  of  inadequate  radio-navigation  coverage.  Autonomy  can  be  examined  in 
five  classes  [4]: 

1.  Passive  self-contained  systems:  This  class  of  autonomy  is  the  most  desired  one  since 
it  neither  receives  nor  transmits  any  electro-magnetic  signals  which  would  reveal 
its  presence,  and  it  does  not  require  any  external  navigation  aid  that  may  not  be 
available  on  the  enemy  territories.  Dead  reckoning  systems  like  inertial  navigation 
systems  (INS)  are  presented  in  this  class. 

2.  Active  self-contained  systems:  These  systems  do  not  receive  any  signals,  but  unfor¬ 
tunately  they  do  transmit  electro-magnetic  signals.  Since  the  transmitted  signals 
are  easily  detectable  by  the  enemy  radar  warning  receivers  (RWR)  or  threat  warning 
systems  (TWS),  they  are  less  desirable  than  the  passive  self-contained  systems. 

3.  Receivers  of  natural  radiation:  Magnetic  compasses,  star-trackers  and  passive  map 
correlators  are  able  to  receive  naturally  transmitted  electro-magnetic  radiation.  As 
in  the  passive  self-contained  systems,  they  are  also  independent  from  any  external 
navigation  aid  and  they  do  not  expose  their  presence. 

4.  Receivers  of  artificial  radiation:  These  systems  completely  depend  on  external  nav¬ 
igation  aids.  Even  if  they  do  not  transmit  any  electro-magnetic  signal  to  reveal 
their  presence,  they  measure  the  electro-magnetic  radiation  sent  out  by  the  external 
navigation  sources.  Loran,  Omega,  VOR  and  GPS  can  be  treated  in  this  class. 

5.  Active  radio  nav-aids:  The  least  autonomous  ones  are  the  active  radio  nav-aids,  such 
as  Distance  Measuring  Equipment  (DME),  Joint  Tactical  Information  Distribution 
System  (JTIDS),  Position  Location  Reporting  System  (PLRS),  and  collision  avoid¬ 
ance  systems  because  of  their  signal  exchange  requirements  with  external  sources. 
It  is  obvious  that  emitting  and  transmitting  electro-magnetic  signals  betray  their 
presence. 

If  INS  is  aided  in  a  way  mentioned  in  Sect.  2.2.4,  transmitting  electro-magnetic  signals 
becomes  unavoidable.  Trade-off  between  INS  aiding  and  presence  giveaway  brings  another 
motivation  behind  this  research:  while  aiding,  also  keep  the  silence  of  INS. 
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2.3.3  Optical  Flow.  One  of  the  motivations  behind  the  formulation  of  the 
tracking  problem  is  the  desire  to  maintain  non-radiating  capability  of  the  INS.  Thus,  pas¬ 
sive,  bearing-only  measurements  of  the  ground  object  should  be  used.  These  measurements 
can  be  provided  by  an  optical  tracker  or  an  electo-optical  tracker.  The  assumption  that  the 
position  of  the  ground  object  is  not  known  will  essentially  introduce  the  measurements  of 
optical  flow.  Basically,  four  different  scenarios  are  possible  when  a  ground  object  is  being 
tracked: 

1.  The  ground  object  is  a  high  intensity  point  source  compared  to  the  surroundings. 
In  this  case,  one  could  use  a  point  source  Infra  Red  (IR)  tracker,  as  used  in  the  IR 
seekers  of  the  guided  missiles.  The  tracking  function  can  be  easily  automated. 

2.  There  is  an  intermediate  level  of  intensity  variation  in  the  scene  of  being  viewed.  In 
this  case,  one  would  use  an  optical  flow  sensor[3]. 

3.  There  are  low  intensity  variations  in  the  observed  scene.  This  is  the  case  a  human 
operator  is  needed  to  close  the  optical  tracking  loop,  similar  to  the  use  of  a  driftmeter 
[9]. 

4.  In  a  very  low  signal-to-noise  ratio  (SNR)  condition  as  in  night  flight,  or  when  flying 
over  cloud  cover  or  water,  one  is  denied  use  of  optical  sightings  of  the  ground  objects 
for  navigation. 

In  this  research,  we  confine  our  attention  to  scenario  3.  However,  the  theory  con¬ 
cerning  the  use  of  optical  and  inertial  measurements  together  is  similar  in  scenarios  1  to 
3.  Furthermore,  INS-aiding  using  measurements  on  a  ground  object  is  intimately  related 
to  the  problem  of  geo-location.  The  latter  entails  the  estimation  of  the  a  priori  infor¬ 
mation  for  the  unknown  position  of  the  ground  object  from  measurements  taken  by  the 
aircraft.  In  this  case,  the  estimation  of  the  ground  object’s  position  relies  on  the  accuracy 
of  aircraft  current  position  and  attitude  knowledge.  It  is  obvious  that  these  navigational 
errors  are  reflected  in  the  ground  object’s  position  estimate.  Conversely,  in  conventional 
INS-aiding,  it  is  usually  assumed  that  the  position  of  the  ground  object  is  known,  and 
range  and  bearing  measurements  are  used  to  obtain  an  independent  position  estimate  of 
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the  aircraft.  Hence,  INS-aiding  and  geo-location  appear  to  be  on  the  opposite  sides  of  the 
same  situation.  Schematically; 


own  ship  position  known  ground  object  not  known 

1  .  ,1  INS— aiding  i  i  •  ,  i 

own  snip  position  not  known  —  ground  object  known 

T  .  .  .  Geo—loc  v.s.  aiding  ,  ^  . 

own  snip  position  < — ground  object 


Using  a  ground  object  for  INS  aiding  to  improve  one’s  position  estimate  and  then 
performing  a  geo-location  of  the  same  ground  object  by  using  just  aided  INS  information  is 
an  illusion.  This  is  not  the  case,  and  in  fact,  the  algorithm  which  operates  on  the  bearing 
measurements  simultaneously,  and  in  parallel,  produces  corrections  required  for  both  INS 
update  and  geo-location. 


2.3.4  Driftmeter.  The  driftmeter  is  a  simple  device  to  measure  drift  and 
ground  speed.  It  makes  the  comparison  possible  between  true  course  and  true  heading  by 
rotating  a  transparent  plate  until  lines  etched  on  its  surface  match  the  track  of  objects 
passing  on  the  ground  below.  The  measured  angle  of  rotation  from  a  reference  line  gives 
the  drift.  Its  gyroscopically  stabilized  structure  makes  it  reliable  to  use  in  rough  air  and 
its  optical  system  can  be  rotated  forward  and  backward  in  the  aircraft  to  provide  a  means 
of  taking  bearing  measurements.  Figure  2.2  presents  a  B-3  Driftmeter.  The  driftmeter 
is  also  used  to  measure  the  ground  speed  by  timing  the  passage  of  an  object  from  one 
line  to  the  other  and  using  the  aircraft  altitude  information.  For  better  accuracy  several 
measurements  are  taken  and  averaged.  It  is  also  possible  to  determine  the  wind  vector 
from  the  drift  and  ground  speed  by  solving  the  wind  triangle  [9]. 


2.4  Conclusion 

The  inertial  system  and  its  time  exponential  drift  error  are  presented  in  this  chapter. 
This  chapter  also  includes  the  methodology  for  eliminating  system  errors.  By  the  current 
technology,  this  can  be  easily  performed  by  aiding  the  INS  with  external  sources.  At  this 
point,  the  trade-off  between  aiding  INS  for  a  better  accuracy  and  keeping  the  silence  for  the 
sake  of  a  successful  intruding  into  the  enemy  depths  is  worth-considering.  The  significance 
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Figure  2.2  B-3  Driftmeter  [9]. 

of  the  INS  autonomy  is  inevitable  in  this  situation.  Although  no  research  exists  on  aiding 
the  INS  by  tracking  unknown  objects,  presented  theoretical  computation  [7]  can  be  detailed 
and  applied  for  ground  object  tracking  formulation. 
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III.  Methodology 

3. 1  Introduction 

In  this  chapter,  we  develop  the  methodology  for  INS  aiding  by  tracking  an  unknown 
ground  object.  The  first  objective  in  the  development  is  to  determine  the  equations  which 
will  make  the  INS  aiding  possible.  Based  on  a  proposed  measurement  scenario,  we  first 
present  the  theory  and  than  we  develop  the  methodology  to  calculate  the  variables  of  the 
INS  aiding  equations. 


3.2  Analysis 

In  the  development  we  consider  the  plane  P  formed  by  the  aircraft’s  velocity  vector 
V  and  the  point  P  on  the  ground  -  see  Fig  3.1.  The  inertial  reference  frame  is  X,  Y,  Z.  A 
local  frame  of  reference  x,  y,  z  is  also  introduced.  Its  origin  is  collocated  with  the  aircraft’s 
initial  position  Xq,Yq,  Zq,  the  x-axis  is  aligned  with  the  aircraft’s  inertial  velocity  vector 
V,  the  y-axis  is  in  the  plane  P,  normal  to  the  x-axis,  and  points  in  the  direction  of  the 
point  P,  and  the  z-axis  complements  the  right  handed  axes  system.  The  aircraft’s  body 
axes  are  Xb,  yt,  and  Zf,-  The  bearings-only  kinematic  measurement  scenario  is  illustrated 
in  Fig  3.1.  The  measurements  are 

1.  Time  t. 

2.  The  LOS  in  inertial  space: 

(a)  The  LOS  angle  ajsf  in  the  (x,  y)  plane  P,  or  the  angular  rate  of  the  LOS  in 
the  plane  P,  and, 

(b)  The  unit  vector  (vi  normal  to  the  plane  P,  obtained  from  the  measurement  of 
the  inertial  LOS  rate  vector  tj;  wi  =  |^. 

3.  The  LOS  relative  to  the  aircraft:  The  direction  cosines  of  the  telescope’s  LOS  vector 
relative  to  the  aircraft’s  body  axes. 
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The  tracker  envisioned  herein  consists  of  a  precision  telescope  mounted  on  a  gimbal  system. 
This  allows  the  telescope  to  remain  pointed  to  the  ground  object  independent  of  vehicle 
motion.  The  direction  of  the  Line  of  Sight  (LOS)  relative  to  the  aircraft  body  axes  is 
measured  by  pickups  attached  to  the  gimbals.  In  addition,  the  inertial  angular  rate  cu 
of  the  LOS  is  measured.  Specifically,  the  following  efficient  mechanization  of  the  optical 
tracker  is  proposed:  The  inertial  angular  rate  u  of  the  LOS  is  measured  using  a  2  Degree-of- 
Freedom  (DOF)  rate  gyro  whose  spin  axis  is  aligned  with  the  optical  axis  of  the  telescope. 
The  gyros’  input  axes  and  the  telescope’s  optical  axis  (=  LOS  in  the  absence  of  tracking 
errors)  form  a  triad  of  orthogonal  axes.  The  telescope  mounted  2  DOF  gyro  directly 
measures  the  angular  rate  a;  of  the  LOS  with  respect  to  an  inertial  reference  frame.  The 
gyro  should  be  of  medium  quality,  so  as  not  to  pick  up  the  earth  rate.  Since  the  gimballed 
tracker’s  azimuth  and  elevation  angles  relative  to  the  aircraft  body  axes  are  measured,  (v 
is  resolved  in  the  aircraft  body  axes.  The  proposed  arrangement  is  akin  to  the  seeker  of 
the  Sidewinder  air-to-air  missile. 

Concerning  the  state  of  the  art  of  optical  tracking  of  ground  objects/targets  from 
aircraft:  Pilots  of  F-16  class  fighter  aircraft  equipped  with  Forward  Looking  Infra  Red 
(FLIR)  targeting  pods  and  pilots  of  FLIR  and  Down  Looking  Infra  Red  (DLIR)  equipped 


Figure  3.1  The  measurement  situation  in  the  3-D  case 
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F-117  attack  aircraft  currently  have  the  capability  to  designate  and  track  ground  targets 
manually  from  high  altitudes  (20,000’). 

We  shall  show  that  the  following  holds. 

Theorem  1  Consider  the  kinematic  measurement  scenario  shown  in  Fig  3.1  where  bearing 
measurements  on  a  ground  object,  whose  position  is  not  known,  are  taken  over  time. 
Assuming  a  constant  aircraft  speed  V  during  the  (short)  measurement  interval,  it  is  then 
possible  to  estimate  the  angles  which  specify  the  direction  of  the  aircraft’s  inertial  velocity 
vector  V  relative  to  the  aircraft’s  body  axes,  viz.,  a'  and  (3' ,  where 

a  =  arctan(— )  ,  (3'  =  arctan(— )  , 

u  u 

and  where  u,  v,  and  w  are  the  components  of  the  inertial  velocity  vector  V  resolved  in  the 
body  axes. 

The  proof  of  Theorem  1  is  given  in  Sect.  3.3  in  the  sequel. 

Thus,  we  realize  that: 

Corollary  2  An  optical  flow  sensor  measures  the  angles  a'  and  f3'  which  specify  the  di¬ 
rection  of  the  aircraft’s  inertial  velocity  vector  relative  to  the  aircraft’s  body  axes. 

□ 

Corollary  3  The  kinematic  measurement  scenario  which  entails  bearing  measurements 
over  time  on  a  ground  object  whose  position  is  not  known,  affords  the  estimation  of  the 
aircraft’s  aerodynamic  angles  a  and  f3,  provided  that  the  air  mass  is  stationary,  viz.,  there 
is  no  wind. 

Proof  The  no  wind /stationary  air  mass  hypothesis  implies  that  the  aircraft’s  inertial  ve¬ 
locity  is  the  airspeed.  Hence,  by  definition,  the  aerodynamic  angles  a  and  f3  satisfy 

a  =  a' 

[3  =  (3' 


□ 


We  also  realize  that  -  see  Sect.  3.3.3: 
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Proposition  4  The  angles  ol  and  (3'  are  related  to  the  aircraft’s  angular  navigation  vari¬ 
ables  roll,  pitch,  yaw  angles,  if),  6,  and  flight  path  angle  7  and  heading  H. 

□ 


Theorem  1  and  Proposition  4  are  exploited  in  Sect.  4.2  in  the  sequel  to  lay  the  foun¬ 
dation  for  INS-aiding  using  bearings-only  measurements,  as  stated  in: 

Theorem  5  The  kinematic  measurement  scenario  which  entails  bearing  measurements 
over  time  on  a  ground  object  whose  position  is  not  known,  yields  two  new  independent 
measurement  equations  featuring  the  aircraft’s  angular  navigation  variables  roll,  pitch,  yaw 
angles,  tp,  0,  (p,  and  flight  path  angle  7  and  heading  H. 


Hence,  a  careful  analysis  of  the  proposed  unknown  landmark  bearing  measurement  scheme 
using  an  optical  or  electro-optical  device  and  summarized  in  Theorem  1  and  Corollary  2, 
reveals  the  following:  A  stand-alone  measurement  of  the  angles  a'  and  jd'  included  between 
the  aircraft’s  inertial  velocity  vector  V  and  the  aircraft  body  axes  is  obtained.  According 
to  Corollary  3,  in  the  absence  of  wind,  an  estimate  of  the  aircraft’s  aerodynamic  angles  a 
and  (3  is  obtained.  More  importantly,  and  irrespective  of  the  presence  of  wind,  the  said 
optical  flow  measurement  can  be  used  for  INS  aiding.  Indeed,  according  to  Proposition  4, 
the  optical  sensor  provided  angles  a'  and  f3'  can  also  be  expressed  as  a  function  of  the  INS 
provided  aircraft’s  Euler  angles  ip,6,(p,  and  the  inertial  aircraft  velocity  vector  angles  7 
and  H]  and  this  in  turn,  allows  the  development  of  an  estimation  algorithm  for  improving 
these  variables’  estimates,  as  stated  in  Theorem  5.  This  should  come  as  no  surprise  - 
indeed,  the  proposed  INS  aiding  concept  is  a  modern  mechanization  of  a  driftmeter  [9]  . 
In  other  words,  the  gist  of  the  research  is  an  investigation  into  INS  aiding  using  a  modern 
driftmeter,  a.k.a.,  optical  flow. 

3.3  Estimation 

In  this  section.  Theorem  1  is  proven. 
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3.3.1  Development  of  the  Regressor  H.  In  the  sequel  we’ll  assume  that 
the  aircraft  overflies  the  ground  object  P  -  see  Fig  3.2  .  Thus  we’ll  confine  our  attention 
to  flight  in  the  vertical  plane  {X,Y)  (=  P).  In  other  words,  we  do  not  allow  for  an  offset 
flight  path  and  the  course  in  Fig  3.1  H  =  however  the  aircraft  could  be  climbing  or 
diving  (7  7^  0).  This  considerably  simplifies  the  development  without  impacting  the  proof 
of  concept.  Moreover,  we  then  obtain  the  following  reduced  set  of  variables  relevant  to 
the  solution  of  the  navigation  problem:  The  navigation  variables  are  Xo,To,F,  7,0,  and 
the  ground  object  coordinates  are  Xp,Yp.  The  ground  object,  referred  to  as  the  point  P, 
has  the  coordinates  (x,  y)  in  the  local  frame  in  the  plane  P.  Since  the  aircraft  overflies  the 
reference  point  P,  the  following  coordinate  transformation  applies. 

Xp  —  Xq  =  X  cos  7  +  y  sin  7 
Yp  —  Yo  =  xsin7  — ycos7  (3T) 

The  bearings  measurements’  time  is  t  and  the  LOS  angle  a{t)  is  in  the  (x,y)  plane  P. 


Figure  3.2  The  measurement  situation  in  the  2-D  case  -  the  plane  P 


3-5 


Measurements  of  the  LOS  angles  are  taken  at  the  time  instants  T^,  A:  =  0, 1, N.  The 
time  intervals  between  measurements  are  denoted  by  tk-  Thus, 

k 

Tk  =  '^ti  (3.2) 

i=0 

As  shown  in  Fig  3.3  a),  the  point  P  is  evidently  located  on  the  circumference  of  the  circle 
Ck,  k  =  0,1, N]  the  circle  Ck  is  the  locus  of  points  where  from  the  angle  of  visibility  of 
the  segment  Vtk  is  (Tk-  Moreover,  the  point  P  is  located  at  the  intersection  of  the  +  1 
circles  Ck  -  see  Fig  3.3b). 

The  radius  of  the  circle  Ck, 


Rk  =  r,  ^  k  =  0,l,...,N 
2  sm  cTfc 


and  the  center  of  the  circle  Ck  in  the  local  {x,  y)  frame  is  at 


fc-i 


^Ck  =  '^VtiPi^Vtk 
i=0 

Vtk 

yCk  =  7TT - 

2  tan  (Tfc 


,  A:  =  1,...,A^, 


and  the  center  of  the  circle  Cq  is  at 


xco 

yco 


T^Vto 

Vto 

2  tan  do 


(3.3) 


(3.4) 


(3.5) 


Cq  is  referred  to  as  the  “prime”  circle.  The  equations  of  the  circles  are 


{x--Vto)  +{y-— - )  = — 

2  2  tan  do  4  sm^  do 


(3.6) 


and 


fc-i 


{x-'^Vti  -  ^Vtkf  +  {y- 
i=0 


_  y^ti 

2tandfc''  4sin^dfc 


,  k  =  l,-,N  (3.7) 
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Eqs.  (3.6)  and  (3.7)  yield  a  set  of  +  1  quadratic  equations  in  x  and  y, 


+  y‘^  —  Vtox - y  =  0 

tan  (To 


(3.8) 


and 


2  I  2 

X  +y 


k-l  y  k-1  k-1 

(2  Vti  +  Vtk)x  -  —^y  =  -( Vtif  -  Vtk  Y,  > 

_ n  _ n  _ n 


k  =  (3.9) 


Subtracting  eq.  (3.8)  from  eq.  (3.9),  and  dividing  both  sides  of  the  resultant  equation  by 
V  and  using  the  definition  (3.2)  for  k  =  1,  ...,iV,  yields  the  linear  homogeneous  system  of 
N  equations  in  x,  y,  and  V: 


{2Tk  -tk-  to)x  +  (4  cot  (Tfc  -  to  cot  ao)y  -  Tk{Tk  -  tk)V  =  0  (3.10) 


The  linear  homogeneous  system  (3.10)  can  be  compactly  written  in  matrix  form  as 


HO  =  {) 


(3.11) 


where  the  parameter  vector 


and  the  N  x  3  regressor  matrix  H 


X  y  V 


T 


H  = 


2Ti  —  ti  —  to  ti  cot  (Ti  —  to  cot  (To  — Ti(Ti— ti) 


“^Tk  —  tk  —  to  4cot(Tfc  —  toCOt(To  —Tk{Tk—tk) 


2T]\f  —  tN  —  to  tjv  cot  (Tat  ~  to  cot  (To  —Tj\f(Tj^  —  t]\f) 


Nx3 


Remark  The  time  measurements  are  accurate  and  therefore  only  the  second  column  of  the 
regressor  H,  where  the  LOS  angles  feature,  is  noise  corrupted. 
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The  following  holds. 

Theorem  6  The  true  rank  of  the  N  x  3  regressor  H  is  2. 

Proof 

When  V  is  considered  a  parameter,  the  solution  x  and  y  of  Eq.  (3.10)  is  homogenous  in 
V.  Hence,  the  “prime”  nonlinear  Equation  (3.8)  is  homogeneous  in  V  and  therefore,  upon 
inserting  the  solution  x  and  y  of  the  linear  system  (3.10)  into  Eq.  (3.8),  it  is  impossible 
to  calculate  V.  Eurthermore,  when  one  inserts  the  above  solution  for  x  and  y  into  the 
quadratic  equation  of  the  “prime”  circle  (3.6),  the  latter  becomes  an  identity. 

□ 


Concerning  the  meaning  of  the  “true”  rank  of  H:  This  is  the  rank  of  a  “clean”  H, 
and  not  the  numerical  rank  of  the  actual,  experimentally  obtained  and  noise  corrupted, 
regressor.  The  deleterious  effect  of  measurement  noise  is  to  increase  the  apparent  rank 
of  the  regressor  H  so  that  the  latter  masquerades  as  a  full  rank,  and  therefore,  invertible 
matrix  (in  which  case  the  parameter  would  be  0  =  0). 

In  conclusion:  Our  regressor  PI  is  an  x  3  matrix.  The  true  rank  of  PI  is  2,  whereas 
a  noise  corrupted  regressor  matrix  H  will  boast  a  rank  of  3.  In  the  deterministic  case 
one  could  pick  any  two  equations  from  the  linear  system  (3.10)  and  express  x  and  y  as  a 
linear  (in  fact,  homogeneous)  function  of  V.  In  the  noiseless  case,  the  same  solution  will  be 
obtained  irrespective  of  which  two  equations  one  uses.  In  the  stochastic  case,  the  following 
course  of  action  is  taken. 

3.3.2  Development  of  the  'Jd  Formula.  As  shown  in  Eig  3.2  in  the 
simplified  planar  case,  the  navigation  variables  consist  of  3  “positional”  variables  and  2 
angular  variables.  They  are  Xq,  Yq,  V,  and  7,  6,  respectively. 

The  navigation  variables  are  assumed  constant  during  the  (short)  measurement  in¬ 
terval. 

The  raw  measurements  are 

1.  The  time  instants  tk,  k  =  0,1, ...,  N. 
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2.  The  LOS  rate  with  respect  to  inertial  space,  i.e.,  /c  =  0, 1, N. 

3.  The  angle  of  depression  of  the  initial  LOS,  9d',  it  is  the  angle  included  between  the 
aircraft’s  x-body  axis  and  the  initial  LOS  to  the  ground  object  P. 

The  raw  measurements  are  pre-processed  and  the  regressor  H  is  formed  according  to  the 
development  in  Section  3.3.1.  The  angle  yu  included  between  the  velocity  vector  V  and 
the  initial  LOS  is  computed  as  follows. 

Performing  a  Singular  Value  Decomposition  (SVD)  of  the  noise  corrupted  regressor 
H  yields  [1] 


H  =  uj:v'^ 

where  U  and  V  are  N  x  3  and  3  x  N  matrices,  respectively.  The  3x3  diagonal  matrix  S 
has  3  singular  values.  The  third  singular  value  is  much  smaller  than  the  first  two  singular 
values.  Set  the  third  singular  value  to  0  and  only  the  nonzero  elements  of  S  are  preserved 
in  a  reduced  2x2  matrix  S.  Furthermore,  the  last  column  of  U  and,  similarly,  the  last 
row  of  V^,  are  removed,  forming  the  reduced  matrices  U  and  V,  respectively.  Take  the 
square  root  of  the  S  matrix  and  form  the  matrices 

H  =  U^^  (3.12) 


and 


K  =  (3.13) 

//  is  a  full  rank  {=  2)  N  x2  matrix  and  iP  is  a  2  x  3  matrix  of  rank  2.  Hence,  we  have 
performed  a  full  rank  factorization  of  the  regressor  H, 


H  =  HK 
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Define  the  reduced  parameter 


e  =  Ke 


(3.14) 


Thus, 


HO  =  {) 


(3.15) 


which  yields 


0  =  0  (3.16) 

Combining  Eqs.  (3.14)  and  (3.16)  allows  us  to  replace  the  original  linear  homogeneous 
system  of  N  equations  with  the  reduced  linear  homogeneous  system  of  2  independent 
equations  in  3  unknowns 


X0  =  0  (3.17) 

where  the  full  rank  matrix  K  is  constructed  according  to  Eq.  (3.13).  Thus,  Eq.  (3.17)  is 
a  set  of  2  linear  equations  in  the  3  unknowns  x,  y  and  V,  viz.. 


Ki^ix  +  7^1,22/  +  =  0 

K2,ix  +  7^2,22/  +  7^2,3!^  =  0 


This  yields  the  solution 


X  =  K^V 
y  =  KyV 


(3.18) 


(3.19) 


3-10 


where  the  “gains”  are  given  by 


Ki^2K2,3  —  K2^2Ki^3 

Ki^iK2,2  —  Ki^2K2,2 

K2,iKi^3  —  i^i  ii^2,3 

Ki^iK2,2  —  Ki^2K2,2 


Evidently,  x  and  y  are  homogeneous  in  V. 
Now,  the  angle 


(3.20) 


7£)  =  arctan(  — ) 
X 


The  SVD  yields  the  “gains”  Kx  and  Ky  and,  in  view  of  Eqs.  (3.19),  we  calculate 

7D  =  arctan(^) 

where  the  “clean”  Kx  and  Ky  parameters  are  the  result  of  the  SVD.  The  above  calculated 
angle  included  between  the  A/C  velocity  vector  and  the  initial  LOS  to  P  is  referred  to 


3.3.3  The  Angle  9^.  In  the  simulation  we  generate  the  angle  included 
between  the  A/C  body  axis  and  the  initial  LOS  to  P, 

Od  =  Id  +  oi  (3.21) 

where  a  is  the  aircraft’s  Angle  Of  Attack,  AOA.  It  is  the  angle  included  between  the 
aircraft  body  axis  Xb  and  flight  path  axis  x.  The  measurement  is  then  generated  as 


=  9  D  +  V2, 


(3.22) 
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where  V2  is  white  Gaussian  measurement  noise  with  the  statistics  below.  Half  a  radian  is 
assumed  a  reasonable  a  value  for  an  optical  tracker. 


V2  = 

aoj,  =  5  X  10“^[rad.]  (3.23) 

At  the  same  time,  a  is  the  difference  between  0  and  7,  which  are  the  INS  measured  pitch 
angle  and  flight  path  angle,  respectively: 


0  =  7  +  0  (3.24) 

The  difference  between  7^)  and  6d  is  also  equal  to  a  -  see  Eq.(3.21).  The  7^  and  9d  mea¬ 
surements  are  provided  by  the  optical  arrangement  described  above.  Thus,  subtracting  Eq. 
(3.21)  from  Eq.  (3.24)  yields  the  equation  which  relates  the  optical  bearing  measurements 
to  the  angular  navigation  variables,  as  stated  in  Proposition  4, 

0D  -  7D  =  0  -  7  (3.25) 

Eq.  (3.25)  makes  INS-aiding  using  bearings-only  measurements  of  a  ground  object,  possi¬ 
ble.  The  development  in  this  section  constitutes  the  proofs  of  Theorem  1  and  Proposition 
4  for  the  simplified  two  dimensional  case. 


Por  the  INS-aiding  analysis  in  this  research,  we  synthetically  generate  a  measurement 
which  is  formed  based  on  the  two  dimensional  measurement  geometry  shown  in  Eig  3.2. 
The  plane  P  is  a  vertical  plane  and  we  are  exclusively  concerned  with  the  measurement  of 
a' .  In  the  general  three  dimensional  case,  the  two  angles  which  define  the  optical  tracker’s 
initial  LOS  relative  to  the  aircraft  body  axes  are  available.  Moreover,  a  stand-alone  esti¬ 
mate  of  the  direction  cosines  of  the  angles  included  between  the  aircraft’s  velocity  vector 
and  the  LOS  to  the  point  P,  viz.,  an  estimate  of  7/5,  and  an  estimate  of  cui,  which  yields 
the  tilt  angle  of  the  plane  P,  are  obtained.  This  then  allows  us  to  calculate  the  two  “aero- 
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dynamic”  angles  of  the  aircraft,  cJ  and  j3' .  Thus,  in  the  general  three  dimensional  case, 
the  two  independent  and  stand  alone  estimates  obtainable  from  the  optical  tracker  are  the 
aircraft’s  aerodynamic  angles  a'  and  jS' ,  i.e.,  two  new  measurement  equations  are  obtained. 
However,  a  cautionary  note  is  in  order:  The  said  angles  are  the  aircraft  aerodynamic  angles 
provided  the  air  mass  is  stationary,  i.e.,  there  is  no  wind.  At  the  same  time,  an  independent 
aerodynamic  measurement  of  the  aerodynamic  angles  a  and  f3  provided  by  the  Air  Data 
Computer  could  be  used  in  conjunction  with  the  optical  tracker  -  provided  measurements 
a'  and  f3' ,  to  estimate  the  prevailing  wind  vector. 

More  importantly,  the  measurements  a'  and  f3'  are  related  to  the  aircraft’s  angular 
navigation  variables  6,  tp,  4>,  7  and  H,  which  afford  INS  aiding.  Evidently,  the  instrument 
cannot  be  used  during  flight  at  night,  over  water,  and  flight  over  cloud  cover. 


3.4  Summary 

Based  on  two  dimensional  measurement  scenario  given  by  Fig  3.2,  we  produce  the 
methodology  to  be  used  in  INS  aiding  by  optically  tracking  an  unknown  ground  object.  In 
particular,  by  taking  a  number  of  LOS  angle  measurements,  we  derive  a  linear  regression  in 
A/C  position  in  local  reference  frame  x  and  y,  and  the  inertial  velocity  vector  V.  This  linear 
regression  yields  two  homogeneous  equation  in  V  so  that  we  can  calculate  the  estimation 
of  two  angles:  the  angle  between  A/C  flight  path  and  initial  LOS  vector,  72?;  and  the  angle 
between  A/C  body  axis  Xb  and  initial  LOS  vector,  Ojy-  Finally,  we  drive  the  INS  aiding 
equation  including  70  and  6d  estimates. 
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IV,  Results  and  Analysis 

4.1  Development  of  Optimal  Measurement  Geometry 

The  objective  here  is  to  find  the  optimal  geometry  for  the  estimation  of  using 
noise  corrupted  LOS  measurements.  The  measurement  equation  is  given  by 

+  i  1  (4.1) 

where  Uj  is  the  i  th  relative  bearing  measurement  taken  at  time  Tj,  and  Vl^  is  white  Gaussian 
noise  with  the  statistics 


^li  =-^(0,cr^i),  =  5  X  10  ^  [rad]  (4.2) 

The  noise  corrupted  bearing  measurements  are  used  in  the  regressor  H  in  Eq.  (3.11), 
and  the  SVD  of  the  regressor  H  provides  the  optimal  “gains”  Kx  and  Ky  which  yield 
71),  the  angle  included  between  the  first  LOS  vector  and  the  aircraft  velocity  vector.  All 
computational  details  are  presented  in  Equations  (3.2)  through  (3.20). 

Based  on  the  measurement  arrangement  shown  in  Fig  3.2,  numerical  experiments  are 
performed  and  the  optimal  measurement  geometry,  which  yields  the  smallest  estimation 
error,  is  obtained. 

4.1.1  Optimal  Geometry  Experiments.  The  optimal  measurement 
geometry  is  attained  when  the  estimation  error  is  small,  i.e.,  the  difference  between  the 
true  (no-noise)  and  the  estimated  7/)  is  minimal.  Although,  in  reality,  the  position  of  the 
ground  object  is  not  known,  we  create  a  synthetic  simulation  scenario  in  which  the  position 
of  the  ground  object  is  known,  and  generate  the  bearing  measurements.  The  latter  are 
corrupted  by  measurement  noise  according  to  Eq.  (4.1).  The  accuracy  of  the  derived  geo¬ 
location  of  the  ground  object,  and  the  7/)  estimation  error,  are  indicative  of  the  quality 
of  the  achievable  estimation  performance.  The  number  of  measurements,  N,  and  the  total 
tracking  time  T,  are  also  considered  since  the  pilot  may  not  be  able,  in  a  high  risk  and 
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dynamic  environment,  to  keep  the  aforementioned  navigation  variables  constant  for  long 
during  the  “navigation  run”.  The  results  of  the  experiments  are  based  on  1000  Monte 
Carlo  runs  and  the  statistics  are  summarized  in  Table  4.1. 


Table  4.1  Measurement  geometry  summary. 


SCENARIOS 

1 

2 

3 

4 

5 

6 

7 

8 

alt  [m] 

7000 

3300 

1000 

300 

300 

300 

300 

300 

7  [!deg] 

-20 

-10 

-5 

0 

0 

0 

0 

0 

7d  [rad] 

0.7024 

0.5151 

0.2798 

0.1746 

0.6423 

0.3490 

0.3490 

0.3490 

ti  [sec] 

1 

1 

1 

1 

0.5 

0.5 

0.5 

0.5 

N 

10 

10 

10 

10 

5 

5 

10 

5 

Tn 

11 

11 

11 

11 

3 

3 

5.5 

4.9 

[m] 

2741.25 

895.11 

18.57 

0.56 

0.03 

1.97 

0.125 

0.008 

eR,  [m] 

-5798.1 

-898.9 

-9.93 

-0.209 

-0.06 

-1.02 

-1.03 

-0.017 

[m] 

390.16 

442.16 

50.18 

4.24 

0.47 

18.66 

1.28 

0.74 

dvp  [m] 

819.98 

448.4 

28.0 

1.7 

0.93 

10.22 

1.1 

0.94 

[rad] 

3.14e-2 

4.595e-3 

2.928e-4 

5.771e-5 

3.210e-5 

1.188e-4 

4.298e-5 

1.397e-5 

[rad] 

6.120e-2 

1.889e-2 

2.932e-3 

5.474e-4 

9.548e-4 

3.720e-3 

6.844e-4 

7.21e-4 

In  the  first  scenario,  Fig  4.1-1,  the  initial  altitude  is  7000  meters  (~  21000  feet)  with 
a  20°  angle  of  descent,  and  10  bearing  measurements  are  taken.  The  sampling  interval 
is  1  sec.  The  velocity  is  200  m/sec  (0.6  M)  and  assumed  constant.  This  entails  a  total 
tracking  time  of  11  sec.  This  initial  scenario  provides  a  poor  geo- location  solution,  and  an 
inaccurate  ■jd  estimate.  The  uncertainty  in  the  bearing  measurements  is  half  a  milli-radian 
(mrad),  however,  the  error  in  y/j  is  approximately  30  mrad. 

To  improve  the  estimation  performance  in  the  second  scenario,  the  altitude  is  de¬ 
creased  to  3300  meters,  as  shown  in  Fig  4.1-2.  Again,  the  number  of  measurements  taken 
is  10.  The  results  are  poor. 

In  the  third  scenario,  the  altitude  is  1000  meters  (~  3000  feet)  with  a  5°  angle  of 
descent.  As  shown  in  Fig  4.2-1,  the  values  of  the  relative  bearing  measurements  are  larger 
than  in  the  previous  experiments,  i.e.,  the  Signal  to  Noise  ratio  (SNR)  increased;  thus,  we 
expect  to  obtain  better  geo-location  and  estimation  performance.  The  results  in  Table  4.1, 
however,  are  not  as  expected.  A  30  mrad  error  in  is  unacceptable  for  the  |  mrad  level 
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Figure  4.1  Measurement  geometry  for  scenarios  1  and  2 


of  measurement  noise.  The  basic  reason  for  this  error  is  slant  range.  1.4  NM  slant  range 
results  in  a  very  small  value  of  LOS  angles  in  which  measurement  noise  is  high  enough  to 
corrupt  this  measurement  and  to  decrease  the  SNR. 


SCENARIO  3 


meters  xio* 


SCENARIO  4 


meters 


Figure  4.2  Measurement  geometry  for  scenarios  3  and  4 


The  fourth  scenario  entails  low  altitude  flight.  In  this  scenario,  Tq)  tbe  initial  altitude, 
is  chosen  300  meters  (~  1000  feet).  Fig  4.2-2  shows  the  geometry  of  this  measurement 
situation.  Actually,  in  this  scenario,  we  conclude  that  the  improvement  in  the  estimations 
results  from  overflying  the  ground  object;  by  so  doing,  we  experience  the  largest  rate  of 
change  of  the  LOS  (the  “cxi’s”  increase),  which  yields  a  higher  SNR  and,  in  return,  better 
performance.  However,  the  initial  small  values  of  Uj  resulting  from  the  long  range  tracking 
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geometry  cause  a  higher  error  in  the  70  estimate.  Thus,  taking  the  measurements  at 
close  range  will  improve  the  estimation  accuracy,  since  the  value  of  the  experimental  Ui 
will  increase,  and  the  measurement  noise  becomes  less  important.  This  geometry  can  be 
obtained  in  a  low  altitude  scenario  and  when  tracking  close  objects. 

In  the  fifth  scenario,  the  effect  of  tracking  at  close  range  with  fewer  measurements 
is  addressed.  The  measurement  geometry  in  Fig  4.3-1  provides  the  best  performance  for 
both  geo-location  and  70  estimation.  Besides,  a  3  seconds  tracking  time  is  the  result  of  a 
faster  sampling  rate  of  to  =  0.5  sec.,  and  is  almost  perfect  for  all  tactical  scenarios.  The 
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Figure  4.3  Measurement  geometry  for  scenarios  5  and  6 


experiments  so  far  allow  us  to  conclude  that  low  altitude  flight,  below  1000  feet,  3  seconds 
of  tracking  time  and,  overflying  the  target,  give  the  optimal  measurement  geometry.  This 
is  the  theoretical  solution  to  the  problem  at  hand;  however,  practical  considerations  impose 
a  constraint  on  the  measurement  situation.  The  constraint  on  the  measurement  geometry 
is  shown  in  Fig  4.4.  The  LOS  depression  angle  is  limited  in  front  of  a  fighter  aircraft. 
For  example,  in  an  F-16  class  A/C  cockpit,  the  LOS  angle  of  depression  is  limited  to 
approximately  17°.  Thus,  since  visual  acquisition  is  needed,  the  pilot  must  initiate  the 
measurement  before  the  ground  object  disappears  below  the  nose  of  the  aircraft.  This 
implies  that  Xq  is  not  chosen  at  will;  its  value  varies  based  on  the  altitude  according  to 
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Eq.  (4.3)  and  the  last  point  to  initiate  a  track  is  determined  by  this  formula. 


Xo  =  Xp 


Yo-Yp 
tan{17°  —  7) 


(4.3) 


We  also  know  that,  for  better  accuracy  in  the  'jp  estimate,  a  minimal  slant  range  is  desired; 
and  the  lower  the  altitude,  the  lower  the  slant  range  to  the  object. 

We  handle  this  constraint  in  two  ways:  First,  by  using  the  FLIR  in  conjunction 
with  the  DLIR,  as  in  F-117  A/C,  the  above  discussed  visibility  constraint  is  removed  , 
in  which  case  the  optimal  measurement  scenario  5  of  Fig  4.3-1  is  applicable.  Second,  the 
measurement  scenario  is  accordingly  revised  taking  this  constraint  into  account,  and  a 
more  robust  technique  is  used  as  discussed  in  the  following  experiments. 

In  the  sixth  experiment,  the  scenario  5  is  repeated,  but  this  time,  the  range  to 
the  ground  object  when  tracking  is  initiated  is  determined  according  to  Eq.  (4.3).  In 
scenario  5,  tracking  has  been  initiated  when  the  slant  range  to  the  ground  object  was 
approximately  0.25  NM;  but  this  time,  the  17°  LOS  depression  constraint  yields  a  slant 
range  of  approximately  0.44  NM.  It  means  that  now,  the  iTi’s  will  have  smaller  values  than 
in  the  previously  investigated  geometries,  so  that  the  SNR  of  the  measurements  is  reduced. 


Figure  4.4  The  pilot’s  LOS  is  17°  from  the  ±30°  of  a  fighter  aircraft  (F-16). 
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The  measurement  noise  we  recall,  has  a  variance  of  0.5  mrad.  Due  to  the  longer  range 
to  the  ground  object,  5  measurements  in  3  seconds  of  tracking  time  will  not  be  enough  to 
overfly  the  object,  as  can  be  seen  in  Fig  4.3-2.  The  statistics  given  in  Table  4.1  show  the 
performance  degradation.  Two  possible  solutions  to  this  problem  are  investigated  in  the 
following  experiments. 

By  choosing  a  high  enough  number  of  measurements,  the  accuracy  can  be  improved; 
but  this  geometry  requires  calculations  with  different  numbers  of  measurements,  based  on 
the  altitude  and  initial  tracking  distance.  Scenario  7  in  Fig  4.5-1  entails  a  measurement 
geometry  with  10  bearing  measurements  during  the  5.5  sec.  tracking  period.  The  statistics 
in  Table  4.1  indicate  an  improvement,  but  it  could  have  better  accuracy.  The  other  solution 

SCENARIO  7  SCENARIO  8 


Figure  4.5  Measurement  geometry  for  scenarios  7  and  8 

to  alleviate  the  visibility  constraint’s  negative  effect  is  to  choose  a  longer  to-  This  means 
that  the  pilot  is  going  to  initiate  the  tracking  at  long  range,  but  the  automated  tracker  is 
going  to  continue  to  take  measurements  when  the  aircraft  is  close  enough  to  the  ground 
object  to  overfly  it.  In  the  8th  experiment  this  measurement  scenario  is  investigated.  The 
statistical  results  of  Scenario  8  show  that  the  geometry  in  Fig  4.5-2  yields  the  minimum 
error  and  the  best  geo-location  performance.  Furthermore,  the  automated  track  initializa¬ 
tion  is  not  dependent  on  the  pilot’s  track  command  whose  timing  may  not  be  predicted, 
and  it  provides  a  robust  way  of  obtaining  the  required  measurements. 

In  conclusion,  the  low  altitude  and  low  slant  range  measurement  geometries  are 
desirable;  however,  depending  on  the  altitude,  the  shortest  slant  range  to  the  ground  object 
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to  be  tracked  is  obtained  as  the  altitude  is  lowered.  To  decrease  the  slant  range  further  to 
the  object,  a  5°  to  10°  descent  is  suggested.  On  the  other  hand,  the  modified  runs  in  which 
one  waits  until  the  range  to  the  ground  object  becomes  small  are  preferable.  We  examined 
two  different  geometries.  The  first  one  is  the  theoretically  optimal  geometry:  low  altitude 
(<  1000  feet),  descending  flight,  with  a  reasonable  number  of  measurements  correlated 
with  tracking  time,  as  shown  in  scenario  5,  Fig  4.3-1;  the  second  geometry  entails  getting 
close  enough  to  the  object  by  using  delayed  tracking.  In  our  work,  we  will  use  the  latter 
scenario,  which  is  illustrated  in  Fig  4.5-2.  For  a  robust  and  more  accurate  measurement 
geometry  synthesis,  the  scenario  is  modified  according  to  the  flight  altitude  and  velocity. 
The  modified  geometry  provides  a  good  estimate  of  jd  for  all  reasonable  altitudes  and 
velocities;  however,  a  10°  to  20°  descent  is  recommended  for  high  altitude  runs.  As  a  rule 
of  thumb,  the  dive  angle  should  be  equal  to  the  flight  altitude  approximately,  e.g.,  for 
an  initial  altitude  of  20,000  feet,  a  20°  dive  angle  is  suggested.  On  the  other  hand,  high 
altitude  INS  updates  require  long  operation  times  to  alleviate  the  deleterious  effects  of  low 
SNR  caused  by  long  range  tracking;  at  first  sight,  this  may  seem  unacceptable,  but  this 
can  be  considered  a  peace-time  mission. 


4‘2  Phase  1  -  Angular  Navigation  Variables 

The  measurement  equation  used  for  INS-aiding  is  based  on  the  development  leading 
to  Eq.  (3.25).  We  define  the  measurement 

^  -  iDmeas  (4-4) 


where 


'yOm.as  =1D  +  V3,  V3  =  Af{0,  0-2^) 


(4.5) 
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Combining  Eqs.  (3.22),  and  (3.25)-(4.5)  yields  the  measurement  Equation  for  INS  aiding: 


=  0D+V2-^D-V‘i 


=  0D  -1D  +  V2-V‘i 

=  0-^  +  vq  (4.6) 


where 


V^  =  V2-  V3 


(4.7) 


and  thus,  the  measurement  noise 


U6  =  AA(0,cj|^ +  0-2^)  (4.8) 

On  the  other  hand,  at  the  time  instant  of  INS  updating,  the  stand-alone  INS  provides  the 
prior  estimates  of  9  and  7,  9~  and  7“,  respectively: 

§-  =  6  + Vi  (4.9) 

7“  =  7-I-U5  (4.10) 


where  Vi  and  U5  are  white  Gaussian  noise  with  the  INS  error  statistics: 


Vi  =  J\f{0,aj) 
V5  =  Af{0,  a?^) 


(4.11) 

(4.12) 


Specifically,  we  will  assume  that  9  and  7  measurement  noises  are  independent  so  that 
they  are  uncorrelated  (see  Chapter  5,  Recommendations)  and  the  INS  performance  at  the 
update  moment  to  be  specified  by 


1 

"^  =  8 

deg. 

(4.13) 

1 

^7  -  g 

deg. 

(4.14) 
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To  Eqs.  (4.9)  and  (4.10),  one  appends  the  measurement  Equation  (4.6),  thus  obtaining  a 
linear  regression  in  7  and  9.  Hence,  we  can  write  the  linear  regression  for  INS  aiding  as 
follows: 


z 

= 

H 

V 

V 

9- 

1  0 

p  -l 

V4 

9 

7“ 

0  1 

V5 

_  7  _ 

z 

1  -1 

_  V6  _ 

(4.15) 


Since  the  value  of  <7^3  changes  for  each  measurement  geometry,  varying  with  altitude,  ve¬ 
locity,  and  flight  path  angle,  the  l-ci  value  of  U3  is  determined  using  a  look-up  table  whose 
entries  are  flight  altitude,  velocity,  and  flight  path  angle. 

The  linear  regression  (4.15)  is  solved  using  the  Weighted  Least  Squares  /  Minimum  Vari¬ 
ance  (MV)  formulae  [5]: 


V+  =  [H^R-^H]-^H^R-^Z 
P+  =  [H^R-^H]-^ 


(4.16) 

(4.17) 


where  is  the  minimum  variance  parameter  estimate,  is  the  predicted  parameter 
estimation  error  covariance  matrix,  and  the  weighting  matrix  R  is  the  equation  error 
covariance 


R  = 


0  0 
0  0 
0  0  (0-2^  +  0-2  J 


(4.18) 


The  justification  of  the  off-diagonal  terms  of  the  R  matrix  above  being  zeros  can  be  shown 
as  the  following. 


R  =  E{VV^] 


E{vl}  E{viV^}  E{v4_vq} 
E{v^va}  E{vl}  E{v5Vg} 
E{vgV4}  E{v6V5}  E{vl} 


(4.19) 
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Diagonal  terms  here  are  equal  to  the  values  of  the  variables.  As  given  in  the  R  matrix 
however,  the  off-diagonal  terms  are  zero  because  of  the  uncorrelatedness  assumption  of  the 
white  Gaussian  noise  samples. 


E{vivj}  =  E{vi}E{vj}  =  0 


(4.20) 


The  solution  (4.16)  and  (4.17)  of  the  linear  regression  (4.15)  yields  the  improved  angular 
navigational  variables  estimates  9  and  7,  thus  accomplishing  phase  1  of  INS  aiding. 


4-2.1  Simulation  Results.  After  1000  Monte  Carlo  (MC)  runs  and  the 
solution  of  the  linear  regression  in  7  and  0,  the  statistics  of  the  angular  navigation  variables 
7  and  9  are  obtained  and  are  documented  in  Table  4.2.  The  statistics  given  in  Table  4.2 
are: 

The  experimentally  obtained  mean  estimation  error  (bias)  in  9  and  7  (after  aiding), 


1 


Nmc 


Nmc 


(4.21) 

(4.22) 


where  9f  and  7)^  are  the  respective  MV  estimates  of  9  and  7  obtained  in  the  i-th  MC 
experiment  and  Nmc  =  1000  is  the  number  of  Monte  Carlo  experiments  performed. 

The  estimation  error  statistics  show  the  improvement  in  the  angular  variables’  estimates 
resulting  from  INS  aiding  using  bearing-only  measurements  on  a  ground  object  whose 
position  is  not  known.  The  experimental  validation  of  the  predicted  variances  of  the 
random  estimation  errors  in  9~^  and  y'*'  is  thoroughly  pursued.  The  “relative  errors”  in 
the  9  and  7  estimates  (after  aiding)  are  also  recorded; 


_  Elrv-e*) 

Eir(7-7+) 

CrpJ  ,  —  - : - 

r  X  (T-.j- 


(4.23) 

(4.24) 
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The  experimentally  obtained  9  and  7  estimation  error  standard  deviations  (after  aiding) 
are 


^l£00(g+  -  0)2 

999 


(4.25) 


(4.26) 


The  predicted  1-a  for  9  and  7  after  aiding  are  given  by  eq.  (4.17),  viz., 


(4.27) 


(4.28) 


We  invariably  obtained  ss  and  ^  . 

The  measured  probability  of  being  within  a  1-a  of  the  true  parameter  vector,  which  is 
experimentally  calculated  as:  “The  number  of  times  out  of  NmC:  the  estimation  error  x) 
satisfies  P~^Xi  <  [dimension  of  Xi]  divided  by  Nmc  \  and  where 


Xi  = 


9t-9 


T 


+ 


7 


is  also  obtained.  The  theoretical  probability  of  the  two  dimensional  parameter  vector 

estimate  being  within  a  l-o"  of  the  true  parameter  is  Pi-a  =  1  —  The  derivation  is 

given  in  Appendix  B. 

It  is  surprising  to  learn  that  the  l-ci  probability  for  a  bivariate  Gaussian  distribution 
in  Euclidian  space  is  calculated  as  1  —  and  it  is  constant,  and  does  not  depend  on  the 
covariance  matrix.  Table  4.2  also  includes  the  l-ci  experimentally  obtained  probabilities 
for  each  flight  condition.  The  experimentally  obtained  1-a  probabilities  are  only  slightly 
higher  than  the  predicted  one.  Hence,  as  shown  in  Table  4.2,  the  experimentally  obtained 
values  of  the  angular  variables’  estimation  errors  variances  are  very  close  to,  or  smaller 
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Table  4.2  Phase  1  -  Statistics  of  7  and  9  estimates. 


0001 

0.8/-5 

108.620 

I^ZITT 

1.64816 

1.62256 

0.80369 

104.911 

2.17513 

1.67214 

1.62256 

0.81873 

36.3 

0.8  /  -5 

0.5 

90.7936 

8.82962 

6.19276 

6.19370 

0.79589 

81.2309 

8.60954 

6.26932 

6.19370 

0 

0 

CM 

0 

00 

0 

35.9 

0.8/0 

36.0262 

2.20672 

1.70252 

1.65673 

0 

0 

CM 

00 

0 

51.4579 

2.22110 

1.67729 

1.65673 

0.80057 

36,9 

0.25 

27.9252 

4.37695 

3.25077 

3.12966 

0.82219 

2.22143 

4.56167 

3.25519 

3.12966 

0.82987 

34.2 

0 

LO 

0 

11.3141 

2.26658 

1.63193 

1.62060 

0.80937 

3.59614 

2.13982 

1.59245 

1.62060 

0.78604 

39.0 

0.125 

108.620 

2.11721 

1.64816 

1.62256 

0.80369 

104.911 

2.17513 

1.67214 

1.62256 

0.81873 

36.3 

10,000 

0.8/-5 

47.3571 

2.14091 

2.05785 

2.09850 

0.77790 

125.633 

2.24532 

2.13204 

2.09850 

0.80693 

39.4 

0.8  /  -10 

0.5 

301.656 

8.78011 

6.33120 

6.81669 

0.73714 

363.925 

8.49471 

6.34829 

6.81669 

0.75319 

50.2 

0.8/-10 

121.064 

2.15242 

1.96388 

2.03929 

0.77100 

19.5928 

2.23353 

2.05224 

2.03929 

0.79595 

41.3 

0.25 

128.924 

4.33003 

3.64329 

00 

10 

1>- 

0 

00 

CO 

0.76944 

112.694 

4.38194 

3.65157 

3.80758 

0.76665 

43.5 

0.5/-10 

49.7374 

2.15509 

1.96755 

2.03033 

CO 

00 

0 

56.3497 

2.17085 

2.01345 

2.03033 

00 

CM 

0 

00 

0 

39.2 

0.125 

121.064 

2.15242 

1.96388 

2.03929 

0.77100 

19.5928 

2.23353 

2.05224 

2.03929 

0.79595 

41.3 

20,000 

0.8/-10 

24.4338 

2.17635 

2.11096 

2.12371 

0.79620 

16.7998 

2.12758 

2.07291 

2.12371 

0.77592 

40.4 

0.8  /  -20 

0.5 

108.938 

8.74514 

6.55585 

6.67755 

CO 

00 

0 

124.887 

9.15095 

6.64704 

6.67755 

0.79095 

46.3 

0.8/-20 

186.681 

2.26192 

2.08650 

2.04848 

0.82084 

35.1121 

2.14477 

1.95191 

2.04848 

0.74841 

41.4 

0.25 

109.808 

4.14329 

3.36806 

3.56449 

0.74977 

109.808 

4.14329 

3.36806 

3.56449 

00 

00 

0 

41.2 

0.5/-20 

24.4319 

2.19945 

2.14255 

2.12791 

0.80159 

102.944 

2.16387 

2.10306 

2.12791 

0.79234 

39.6 

0.125 

186.681 

2.26192 

2.08650 

2.04848 

0.82084 

35.1121 

2.14477 

1.95191 

2.04848 

0.74841 

41.4 
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than  the  predicted  variances.  This  means  that  the  estimation  algorithm  works  and  filter 
divergence  is  avoided. 

It  is  noteworthy  that  at  the  completion  of  Phase  1 ,  the  angular  navigational  variables 
are  exclusively  updated.  While,  at  this  point  in  time,  the  enhancement  of  the  accuracy  of 
the  aircraft’s  attitude  measurement  does  not  directly  translate  into  an  improvement  in  the 
aircraft’s  position  estimate,  accurate  attitude  information  is  crucial  in  modern  sensor-rich 
platforms  for  e.g.,  laser  beam  pointing. 


4 >3  Phase  2  -  Positional  Navigational  Variables 

In  Phase  1,  we  have  exclusively  addressed  the  angular  navigation  variables,  and  we 
updated  the  estimates  of  0  and  7  using  optically  acquired  bearings-only  measurements. 
We  obtained  the  improved  angular  navigation  variables’  estimates  6~^  and  7^.  In  order  to 
update  the  positional  variables,  we  need  to  include  additional  measurements. 

In  Phase  2,  we  derive  two  different  algorithms  to  update  the  INS  positional  variables. 
The  first  one  derived  in  Sect.  4.3.1  is  a  standard  linear  regression  using  Phase  1  results 
and  A/C  position  and  velocity  estimates  from  the  INS.  For  the  second  algorithm  given  in 
Sect.  4.3.2,  we  use  the  A/C  velocity  information  and  the  slant  range  to  the  ground  object, 
which  is  obtained  by  using  x  and  y  estimates  of  Phase  1,  to  obtain  a  linear  regression.  The 
latter  comes  as  a  singular  linear  regression. 

We  simulate  6  different  measurement  scenarios  for  each  algorithm  to  investigate  the 
estimation  performances.  Sit  represents  the  “measurement  situations”  for  the  scenarios 
simulated  for  standard  linear  regression.  Similarly,  Sen  represents  the  “measurement 
scenarios”  for  the  scenarios  simulated  for  singular  linear  regression.  Definition  of  each 
measurement  situation  and  scenario  is  given  in  Table  4.3.  This  table  explains  the  included 
measurements  and  the  estimation  variables  in  corresponding  simulations.  Derivation  of 
the  Sits  and  Sens  are  given  in  the  Sects. 4. 3.1  and  4.3.2. 

The  statistics  of  the  noise  terms  used  in  the  measurement  equations  during  the 
derivation  of  measurement  situations  and  scenarios  are  chosen  using  the  knowledge  of 
myself  as  a  pilot.  Furthermore,  the  variable  are  assumed  “uncorrelated”;  thus,  by  a  similar 
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calculation  to  Eq.  (4.20),  the  ofF-diagonal  terms  for  all  the  equation  error  covariance 
matrices  become  zeros. 

Table  4.3  Definition  of  each  measurement  situation  and  scenario. 


Osit 

Situations 

Included  Measurements 

Scenarios 

dsen 

x,y,V 

Sit  1 

cjj  only 

Sen  1 

V,R,Xo,Yo,Xp,Yp 

x,y,V,  Xq,  Yq,  Xp 

Sit  2 

+  Yp 

Sen  2 

V,R,Xo,Yo,Xp,Yp 

x,y,V 

Sit  3 

<Xi  +  Rm 

Sen  3 

V,R,Xo,Yo,Xp,Yp 

x,y,V,Xo,Yo,Xp 

Sit  4 

-\-  Yp  -|-  Rrn 

Sen  4 

V,R,Xo,Yo,Xp,Yp 

x,y,y  ,Xq,%,Xp 

Sit  5 

(Ti  -\-  Yp  -|-  Xp 

Sen  5 

V,R,Xo,Yo,Xp,Yp 

x,y,V,Xo,Yo,Xp 

Sit  6 

(Xi-\-  Yp  -|-  Xp  -|-  Rfn 

Sen  6 

V,R,Xo,Yo,Xp,Yp 

4-3.1  Standard  Linear  Regression.  First,  we  incorporate  own-ship 
position  and  velocity  measurements  and  solve  a  linear  regression  in  x,  y,  V,  Xq,  Iq:  Our 
point  of  departure  is  Eq.  (3.19),  relating  the  principal  variables  x,  y,  and  V: 

X  =  K^V 
y  =  KyV 

where  Kx  and  Ky  are  relatively  “clean”;  recall  that  they  are  the  output  of  the  SVD 
algorithm’s  application  to  the  noise  corrupted  regressor  H. 

From  the  INS,  we  also  have  the  own  ship  speed  measurement  Vm,  i-e., 

Vm  =  V  Vy  (4.29) 


where  the  measurement  error 


W  =  AA(0,cry) 
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Thus,  we  form  the  linear  regression  in  the  principal  variables  x,  y,  and  V: 


z 

= 

H 

X 

+ 

V 

0 

1 

o 

1 

_ 1 

x 

Vx 

0 

= 

0  1  -Ky 

y 

+ 

Vy 

0  0  1 

V 

Vy 

The  equation  error  covariance  matrix  is 


-^3x3 


P.,y{l,l)  Px,y(l,2)  0 

P.,y{2,l)  P,,y{2,2)  0 

0  0  a? 


where 


E{vl^}  =  4 


ay  =  2.5  ftjsec. 


and 


P. 


[Vx 


(4.30) 


(4.31) 


(4.32) 


(4.33) 


Px,y  is  synthetically  obtained  as  follows. 

For  each  specified  scenario,  in  Phase  1,  we  perform  a  MC  experiment  to  obtain  the 
statistics  of  the  errors  in  x  and  y.  Thus,  assuming  V  is  known,  we  estimate  Xi  and  y*, 
i  =  1,2,  N  =  1000,  and  according  to  the  Eq.  (4.33),  we  experimentally  obtain  the 

2x2  covariance  matrix  Px^y  which  renders  the  statistics  of  the  x  and  y  estimation  errors. 
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Using  the  MV  formulae,  (4.16)  and  (4.17),  we  calculate  the  principal  variables’  statis¬ 


tics 


X 

X 

y 

=  Af{ 

y 

V 

V 

(4.34) 


where 


(4.35) 


and 


X 

y 

V 


P  =  (H'^R-^H)-^ 


(4.36) 


From  the  INS,  two  additional  measurements  related  to  own  ship  position  are  obtained 


^Om  =  ^0  +  VXo 

Yom  =  ^0  +  VYo 


where 


E{vx^)  =  (Txo 

and  we  assume,  at  INS  update  time. 


and 


^Xo  =  0.8  [nm] 


Eiv^Vo)  =  4o 

(^Yo  =  75  [ft] 


(4.37) 

(4.38) 


(4.39) 


(4.40) 


(4.41) 
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so  that  the  covariance  matrix  Pxo,Yo 


Pxo,Yo 


0 


(4.42) 


Inclusion  of  Additional  Positional  Variables:  7,  Xq,  Yq,  Xp,  and 
Yp  .  We  replace  7  in  the  coordinate  transformation  Eqs.  (3.1) 

Xp  =  xcos'y  +  ysin^  +  Xq 
Yp  =  xsin'j  —  ycos^  +  Yq 

with  the  estimate  from  Phase  1,7,  where 

7  =  7  +  (4.43) 

and 

=  AA(0,cj^)  (4.44) 

_  p+ 

W  —  ^2,2 

We  apply  the  small  angle  approximation  and  we  obtain 

Xp  =  COS7  X  +  sin^  y  +  Xq  +  {Yp  —  Yff)v^  (4.45) 

Yp  =  sin7  X  —  cosj  y  +  Yq  +  (X()“  —  Xp)v^  (4.46) 


Hence,  from  now  on,  we  have  5  positional  variables:  {x,y,V,  Xq,Yq)  G  TZ^.  The  linear 
regression  is 
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and 


0 

1 

0 

-K, 

0 

0 

X 

Vx 

0 

0 

1 

-Ky  : 

0 

0 

y 

Vy 

Vm 

= 

0 

0 

1  : 

0 

0 

V 

+ 

vv 

0 

0 

0  : 

1 

0 

Xo 

VXo 

0 

0 

0  : 

0 

1 

To. 

- 1 

P^,y{l,l)  Px,y{l,2) 

P,,J,(2,1)  Px,j,(2,2) 


R  = 


0 

0 

0 


0 

0 

0 


0 

0 


0 

0 


0  0 
0  0 
0  0 

4o  0 

0  4o 


(4.47) 


(4.48) 


It  is  important  to  note  that  now  the  parameter  vector  does  not  include  the  two  angular 
navigation  variables  9  and  7  which  have  been  previously  estimated.  The  angular  variables 
were  estimated  in  Phase  1,  and  now  are  used  in  Phase  2.  The  positional  variables  are 
estimated  in  Phase  2.  Thus,  we  have  separated  the  angular  and  positional  navigation 
variables’  estimation. 


Moreover,  the  linear  regression  (4.47)-(4.48),  has  a  blocked  structure.  Thus,  without 
solving  the  linear  regression,  we  can  directly  state 


Xo  =  AA(Xo„,4j 

(4.49) 

To  =  AA(yo^,4j 

(4.50) 

4-18 


i.e. 


^0  =  (4.51) 

=  4b^  (4.52) 

The  MV  solution  to  the  upper  left  3x3  linear  regression  block  yields  the  estimate  of  x,  y,  V 
to  be  used  in  the  geo-location  of  the  unknown  point  P. 

Measurement  Situation  1  -  Geo-Location  Using  Optical  Bearings- 
Only  Measurements.  Replacing  x  and  y  with  the  estimate  x  and  y  in  the  Eqs.  (4.45) 
and  (4.46),  we  perform  the  geo-location  of  the  point  P. 

Xp  =  cosj  X  +  sinj  y  +  Xq 

Yp  =  sinj  X  —  cos^  y  +  Yo  (4.53) 


In  this  calculation,  we  set 


Xo  =  Xo^,  Vo  =  4b™ 


4. 3. 1.1  Inclusion  of  Ground  Object  Position  Information.  As¬ 
suming  that  the  ground  object  is  at  a  “known”  location,  two  additional  position  “mea¬ 
surements”  may  be  generated: 


=  Xp  +  vxp 

(4.54) 

Yp^ 

=  Yp  +  VYp 

(4.55) 

The  prior  information  in  Eqs.  (4.54)  and  (4.55)  is  included  in  the  linear  regression  and  we 
augment  the  parameter  vector,  thus  forming  the  complete  7  element  parameter  vector  of 
positional  variables 

[x  y  V  Xo  Vo  Yp)  G 
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Backing  out  from  Eq.  (4.45)  and  then  inserting  it  into  Eq.  (4.46),  we  obtain 


Xp  =  — 


x-p  -  X, 


-X  + 


y 


Y-  -  YY  Yp  - 

-y  +  Xo  +  -  — - —Yp 

\r—  V—  ^  ^  V~  V~  ^  V~  V~  ^ 

Ap  Aq  Ap  Aq  Ap  Aq 


(4.56) 


where 


X  =  {Xp  —  Xq  )cos7  +  (Yp  —  Yq  )sin7 
y~  =  {Xp  -  Xq  )sm7  -  (Yp  -  Yq”  )cos7 


(4.57) 

(4.58) 


Next,  we  insert  Eq.  (4.56)  into  Eq.  (4.54)  and  obtain 


X 


r  .  .  ^  .  Yp-Y„-  Fp  -y„ 


y-  _  Y--^  +  Y-'-  Y-«  +  -'^0  +  y-U  +  '•-Vp  ('‘■59) 

Ap  Ag  Ap  Aq  Ap  Ag  Ap  Aq 


and  we  back  out  Yp,  obtaining 


Yp  = 


X 


y-  Xp  -  X-  Xp  -  X- 

x+ .J  .._y  +  Yo+  ^ZXp 


Yp--Yg-  Yp--Yg 


Yp  -  Yo 


Yf  -  Yo 


(4.60) 


Inserting  Eq.  (4.60)  into  Eq.  (4.55),  we  obtain 


X  p  p  f)  ,  , 

y-  _Y-^  +  y-  _Y-y  +  ^0  +  _  ^0  -  _  -Yp  +  (4.61) 

Ip  Iq  Ip  Iq  Ip  Iq  Ip  rg 


4. 3. 1.2  Measurement  Situation  2  -  Inclusion  of  Ground  Object  Al¬ 
titude  Measurement.  It  is  plausible  that  a  prior  information  on  the  altitude  of  the 
ground  object  is  available;  or,  point  P  might  be  at  sea-level,  i.e.,  Yp^  =  0.  Thus,  the  new 
“measurement”  is  included 


Yp^  =Yp  +  VYp  (4.62) 

with  the  measurement  error  statistics 

E{vh)  =  4p 

OYp  =  100  ft  (4.63) 
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Including  this  new  measurement  into  the  linear  regression  formulation,  we  obtain  the  non¬ 
singular  linear  regression 


Z  =  He +  V 


where  the  measurement  vector 


Z  = 


0  0  Vm 


Y.  Yr 


Pm 


the  regressor 


H  = 


1 

0 

0 

0 

0 


0 

1 

0 

0 

0 


-K, 

-Ky 

1 

0 

0 

0 


0 

0 

0 

1 

0 


0 

0 

0 

0 

1 

1 


the  parameter 


9  = 


X  y  V  Xo  Yo  Xp 


and  the  equation  error 


V  = 


iT 


Vx  Vy  Vv  VXo  VYo  VYp 


(4.64) 


(4.65) 


(4.66) 


(4.67) 


(4.68) 


The  coefficients  Kx  and  Ky  were  estimated  in  Phase  1,  and  x  and  y  are  given  in  Eqs. 
(4.57)  and  (4.58).  The  equation  error’s  covariance  block  diagonal  R  matrix  needed  in  the 
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MV  estimation  formulae  is 

P:,,y{l,l)  Px,y{l,2)  0  0  0  0 

P^,y(2,l)  Px,y(2,2)  0  0  0  0 

0  0  a?.  0  0  0  , 

(4.69) 

0  0  0  0  0 
0  0  0  0  0 
0  0  0  0  0 

Thus,  using  the  MV  estimation  formulae  (4.16)  and  (4.17),  we  obtain  the  MV  parameter 
estimate  9  =  (x,  y,  V,  Vq,  Yq,  Xp)  and  the  parameter  estimation  error  covariance  Next, 
we  revisit  Eq.  (4.60)  for  the  estimation  of  Yp  to  complete  the  geo-location.  The  availability 
of  Yp  information  will  improve  the  own-ship  position  estimate. 

4-3. 1.3  Inclusion  of  Slant  Range  Measurement.  We  consider  an 
additional  scenario  where  the  slant  range  to  the  point  P,  the  tracked  ground  object,  is  also 
measured.  The  measurement  equation  is 

Pm  =  P  P  vp  (4.70) 

where  P  is  the  true  slant  range  and  the  measurement  error  statistics  are 

VR  =  AA(0,cj|) 

OR  =  200  ft.  (4.71) 

This  measurement  is  treated  as  follows. 

The  non-linear  geometric  relationship 

x‘^  +  y^  =  P^  (4.72) 
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holds.  We  use  the  identities 


X  =  X  +  (x  —  X  )  (4.73) 

y  =  y~  +  {y-y~)  (4.74) 

where  x~  and  y~  are  the  current  best  estimates  of  the  x  and  y  coordinates  of  P  in  the 
local  reference  frame.  Inserting  Eqs.  (4.70),  (4.73),  and  (4.74)  into  Eq.  (4.72)  yields 

RL  -  ‘^RmVR  ^  {x~f  +  {y~f  +  2x~{x  -  x~)  +  2y~{y  -  y~)  (4.75) 

and  thus 

2x~x  +  2y~y  -  {x~f  -  {y~f  ~  -  2R^vr 

Re-arranging,  we  obtain 

x~x  +  y~y  =  ^[RI^  -h  (x“)^  -h  {y~)‘^]  -  RmVR 
We  define  the  “measurement” 

^=2[R^  +  {^  )^  +  (y  )^]  (4.76) 


and  thus 


z  = 


X 

y 


+  RmVR 


(4.77) 


This  linearized  measurement  equation  can  be  directly  added  to  any  of  the  previously  dis¬ 
cussed  linear  regressions  in  Sects.  4. 3. 1.2  and  4. 3. 1.4. 


Measurement  Situation  3  -  Bearings- Only  Measurements  and 
Slant  Range.  Including  the  slant  range  measurement  in  the  linear  regression  in  the 
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primary  variables  yields  the  augmented  linear  regression 


0 

1 

0 

r-  -| 

Vx 

X 

0 

=. 

0 

1 

-Ky 

y 

+ 

Vy 

'^m 

0 

0 

1 

V 

vv 

Z 

x~ 

y~ 

0 

RmVR 

The  equation  error  covariance  matrix  is 


P 

p 

0 

0 

p 

p 

^x,y22 

0 

0 

0 

0 

0 

0 

0 

0 

Rl^a] 

(4.78) 


(4.79) 


Obviously,  iterations  on  x  and  y  are  required.  We  will  use  the  initial  guesses  of 


Xq  —  RjYiCos'yD,  yg  —  Ruisin^jy 


(4.80) 


Measurement  Situations  4  -  Bearings- Only  Measurements,  Al¬ 
titude  of  the  Point  P  and  Also  Slant  Range  Measurement  is  Available.  The 

objective  here  is  simultaneously  to  estimate  the  A/C  position  and  to  geo-locate  the  point 
P  using  passive  bearings  measurements  and  a  combination  of  a  measurement  of  the  slant 
range  to  the  point  P,  and  altitude  estimate  of  point  P. 

Including  the  slant  range  measurement  in  the  linear  regression  equation  derived  in  Phase 
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2,  we  obtain  the  augmented  7x6  regressor 


H  = 


1 

0 

0 

0 

0 


0  -K^  0  0 

1  -Ky  0  0 

0  10  0 

0  0  10 

0  0  0  1 

y~  Q  ^p~^o  1 

yp-Yo~  Yp-Yo- 

y~  0  0  0 


0 

0 

0 

0 

0 

Xp-Xp 

Yp-Yp- 

0 


(4.81) 


and  measurement  vector  Z,  parameter  vector  6,  and  measurement  noise  vector  V, 


0 

_  _ 

Vx 

X 

0 

y 

Vy 

km 

V 

vv 

,  0  = 

Xo 

,  k^  = 

VXo 

VYp 

Vo 

VYp 

_Srm_ 

_Rm'VR_ 

(4.82) 


respectively.  The  augmented  block  diagonal  equation  error  covariance  matrix  is 


-fx,J/(l;  1) 


-fx,j/(2, 1) 


0 

0 

0 

0 

0 


Px,y{^,  2) 
2,(2, 2) 
0 
0 
0 
0 
0 


0  0 

0  0 

al.  0 

0 

0  0 

0  0 

0  0 


0  0 
0  0 
0  0 
0  0 

4o  0 
0 

0  0 


0 

0 

0 

0 

0 

0 

0  Ri,vl_ 


(4.83) 
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Again,  applying  the  MV  estimation  formulae,  we  calculate  the  minimum  variance 


estimate  (4.16)  and  (4.17), 


e 


T 


X  y  V  Xo  Yo  Xp 


(4.84) 


and  the  6x6  estimation  error  covariance  matrix  The  geo-location  calculation  is 

completed  by  estimating  Yp  via  Eq.  (4.60). 


4. 3. 1.4  Measurement  Situation  5  -  Inclusion  of  the  Ground  Object 
X  -  Coordinate  Information.  We  consider  a  scenario  in  which  the  Xp  position  of 
the  ground  object  is  also  available.  This  leads  us  into  a  measurement  situation  in  which 
complete  information  on  the  ground  object  is  assumed  “known” . 

Thus,  an  additional  “measurement” 


=  Xp  +  vxp 


(4.85) 


where 


E{vh)  =  4, 

axp  =  100  ft  (4.86) 

is  included  in  the  linear  regression  equation  (4.64)  as  the  last  row. 

We  obtain  the  new  MV  estimate  6  =  {x,y,V,  Xo,Yo,  Xp)  and  the  estimation  error 
covariance  P  according  to  Eqs.  (4.16)  and  (4.17)  where  the  equation  error  covariance 
matrix  R  is  again  block  diagonal.  The  geo-location  parameter  Yp  is  again  obtained  using 
Eq.  (4.60) 


Measurement  Situations  6  -  Bearings- Only  Measurements,  Al¬ 
titude  and  Position  of  the  Point  P  Available,  and  Also  Slant  Range  Measure¬ 
ment  is  Available.  Similar  to  measurement  Scenario  4,  using  passive  bearings 

measurements  and  a  combination  of  a  measurement  of  the  slant  range  to  the  point  P,  and 
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either  a  rough  altitude  estimate  of  point  P  (no  measurement),  or  the  position  information 
of  the  point  P,  we  aim  to  aid  INS  for  its  positional  variables  and  to  estimate  the  position 
of  the  ground  object. 

Including  the  slant  range  measurement  in  the  linear  regression  equation  derived  in 
Phase  2,  we  obtain  the  augmented  8x6  regressor 


1 


H  = 


0 

0 

0 

0 


0 


X 


0 

1 

0 

0 

0 

Yp-Yo 

0 

y~ 


-Kx  0 

-Ky  0 

1  0 

0  1 

0  0 

n 

Yp-Yo 

0  0 

0  0 


0 

0 

0 

0 

1 

1 

0 

0 


0 

0 

0 

0 

0 

^p-^0~ 

^p--v 

1 

0 


(4.87) 


and  measurement  vector  Z,  parameter  vector  0,  and  measurement  noise  vector  V, 


0 

Vx 

0 

X 

Vy 

Pm 

y 

vv 

,  0  = 

V 

,  v  = 

VXo 

Xo 

VYo 

Yo 

VYp 

VXp 

1 - 

1 _ 

1 

1 _ 

(4.88) 
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respectively.  The  augmented  block  diagonal  equation  error  covariance  matrix  is 


Px,y{l,2)  0  0  0 

P:,,y{2,2)  0  0  0 

0  0  0  0 
0  0  0  0 
0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 


0  0 

0  0 

0  0 

0  0 

0  0 

^Yp  0 

0 

0  0 


0 

0 

0 

0 

0 

0 

0 

p2  2 


(4.89) 


Again,  applying  the  MV  estimation  formulae,  we  calculate  the  minimum  variance  estimate 
(4.16)  and  (4.17), 


e 


X  y  V  Xo  % 


(4.90) 


and  the  6x6  estimation  error  covariance  matrix  P^ .  The  geo-location  calculation  is 
completed  by  estimating  Yp  via  Eq.  (4.60). 


4. 3. 1.5  Simulation  Results.  We  perform  5000  of  MC  experiments  on 
each  measurement  situation  and  the  results  of  the  experiments  are  given  in  the  following 
sections. 


Simulation  Results  -  Measurement  Situation  1.  In  Phase  1, 
no  improvement  in  own-ship  position  estimate  is  obtained.  Recall  that  an  improvement  in 
own-ship  angular  variables’  estimates  was  obtained. 

At  this  stage  of  our  work,  we  have  estimated  x,  y,  and  V  using  bearings-only  measure¬ 
ments.  In  parallel,  we  have  calculated  the  coordinates  of  the  ground  object.  The  velocity 
estimation  and  geo-location,  based  on  the  linear  regression  derived  above,  are  analyzed  for 
variable  flight  altitude  in  Table  4.4,  and  analyzed  for  varying  airspeed  in  Table  4.5. 

It  is  observed  that  the  velocity  estimation  performance  has  a  random  nature  for  both 
altitude  and  velocity  variations.  The  l-o"  error  of  A/C  velocity  before  aiding  (2.5  ft /sec) 
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Table  4.4  Measurement  Situation  1  -  Estimation  performance  for  different  flight  alti¬ 
tudes.  The  velocity  is  0.8  M,  the  measurement  errors  during  the  estimation 
process  are  criNSgs,^  =  |  deg,  amsy  =  2-5  ft/sec,  crmsxo  =  0-8  NM  (1481.6 
m),  and  ctinSyo  —  ft-  "^de  predicted  1-a  value  of  the  velocity  estimate  is 
the  same  with  (TVinsi  2-5  ft/sec. 


h  [ft] 

^Ev  [ft /sec] 

[“] 

e^+  [m] 

[ft] 

e^+  [ft] 

1000 

2.458 

1478.11 

12.11 

74.52 

1.27 

3,000 

2.522 

1485.72 

9.28 

80.81 

1.09 

6,000 

2.499 

1503.41 

27.97 

110.13 

1.78 

10,000 

2.490 

1464.62 

8.26 

209.55 

0.66 

15,000 

2.506 

1486.04 

29.76 

28.88 

1.38 

20,000 

2.496 

1479.03 

22.46 

340.02 

5.46 

Table  4.5  Measurement  Situation  1  -  Estimation  performance  for  different  airspeeds. 

The  flight  altitude  is  3,000  feet,  and  the  measurement  errors  during  the  esti¬ 
mation  process  are  as  in  Table  4.4. 


Vel  [M] 

^Ev  [ft /sec] 

[“] 

e^+  [m] 

[ft] 

ey+  [ft] 

0.5 

2.484 

1489.08 

23.02 

84.64 

0.35 

0.6 

2.525 

1471.16 

0.46 

80.92 

0.91 

0.7 

2.539 

1487.41 

8.84 

81.33 

1.31 

0.8 

2.473 

1479.82 

30.59 

81.68 

0.05 

0.9 

2.546 

1466.30 

27.54 

78.40 

0.33 

1 

2.523 

1482.84 

37.23 

77.49 

0.21 

is  unchanged  after  aiding;  that  is,  there  is  no  significant  improvement,  the  A/C  velocity 
estimate  is  about  the  same.  Geo-location  performance,  however,  is  basically  determined 
by  the  INS-provided  own-ship  position  estimate.  As  shown  in  Tables  4.4  and  4.5,  the  1-cr 
values  for  both  Xp  and  Yp  are  about  the  1-a  of  the  A/C  x  and  y-position  errors.  The 
increase  in  altitude,  and  decrease  in  A/C  velocity  result  in  a  deterioration  in  geo-location 
performance.  The  latter  is  a  result  of  the  measurement  arrangement,  as  explained  in  Sect. 
4.1. 

We  conclude  that  in  the  Measurement  Situation  1  the  basic  objective  of  INS  posi¬ 
tion  aiding  is  not  met;  however,  we  can  perform  a  geo-location  estimation,  but  it  will  be 
accurate  as  much  as  the  INS-provided  own-ship  position  measurement’s  accuracy.  Erom 
this  conclusion,  we  can  not  suggest  this  kind  of  scenario  for  any  application. 
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Simulation  Results  -  Measurement  Situation  2.  The  result 
of  the  simulations  are  documented  in  the  following  tables:  Table  4.6  shows  the  velocity 
estimation  and  geo-location  performance  as  a  function  of  flight  altitude.  Own  ship  position 
estimation  performance  for  varying  flight  altitudes  is  documented  in  Table  4.7.  The  results 
for  various  airspeeds,  are  presented  in  Tables  4.8  and  4.9. 


Table  4.6  Measurement  Situation  2  -  Estimation  performance  for  different  flight  alti¬ 
tudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement  errors  during  the 
estimation  process  are  crjNSg^^  =  |  deg,  ajNSv  =2.5  ft /sec,  ajNSx  =0.8 
NM  (1481.6  m),  and  (TjnSyq  ~ 


h  [ft] 

^Ev  [ft /sec] 

[“] 

e^+  [m] 

[ft] 

ey+  [ft] 

1000 

2.485 

1485.45 

25.79 

99.48 

2.94 

3,000 

2.550 

1486.75 

44.13 

97.75 

2.09 

6,000 

2.521 

1486.10 

2.41 

99.29 

0.16 

10,000 

2.505 

1497.33 

25.97 

99.42 

2.10 

15,000 

2.490 

1496.67 

20.93 

100.93 

0.65 

20,000 

2.525 

1540.67 

130.41 

101.03 

3.14 

Table  4.7  Measurement  Situation  2  -  Own  ship  position  estimation  performance  for  dif¬ 
ferent  flight  altitudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement  errors 
during  the  estimation  process  are  given  in  Table  4.6  . 


h  [ft] 

[“] 

ex+  [“] 

[ft] 

ey+  [ft] 

1000 

1485.29 

27.56 

75.47 

0.13 

3,000 

1486.69 

43.72 

74.54 

0.69 

6,000 

1485.14 

2.64 

74.91 

0.39 

10,000 

1495.02 

23.97 

74.27 

1.89 

15,000 

1479.78 

3.23 

75.96 

0.52 

20,000 

1465.71 

43.34 

75.45 

0.27 

At  this  stage,  a  general  observation  concerning  velocity  estimation  performance  in 
all  the  experiments  is  in  order:  Velocity  aiding  is  not  significant.  The  velocity  estimates 
are  very  close  to  the  values  prior  to  aiding.  Geo-location  performance  depends  on  the  INS 
provided  own  ship  position  information  for  Xp,  and,  for  Yp  estimation,  the  quality  of  the 
prior  information  on  the  altitude  of  the  ground  object  is  crucial.  A  decrease  in  geo-location 
accuracy  is  observed  when  the  flight  level  is  increased.  The  effect  of  airspeed  variation  on 
geo-location  is  random.  Own  ship  position  estimates  errors,  however,  are  usually  close  to 
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Table  4.8 


Measurement  Situation  2  -  Estimation  performance  for  different  A/C  speeds. 
The  altitude  is  3,000  feet,  and  the  measurement  errors  during  the  estimation 
process  are  criNSgs,^  =  |  deg,  amSy  =  2-5  ft/sec,  ctinSxq  =  0-8  NM  (1481.6 
m),  and  (JinSyo  ^ 


Vel  [M] 

^Ev  [ft /sec] 

[“] 

e^+  [m] 

[ft] 

ey+  [ft] 

0.5 

2.513 

1444.26 

13.74 

100.91 

3.47 

0.6 

2.502 

1498.24 

13.33 

99.81 

2.66 

0.7 

2.498 

1465.90 

17.65 

100.03 

0.89 

0.8 

2.465 

1481.69 

29.46 

102.00 

2.33 

0.9 

2.515 

1482.03 

24.65 

101.84 

0.80 

1 

2.469 

1483.72 

67.01 

99.44 

4.07 

Table  4.9  Measurement  Situation  2  -  Own  ship  position  estimation  performance  for  dif¬ 
ferent  A/C  speeds.  The  altitude  is  3,000  feet;  and  the  measurement  errors 
during  the  estimation  process  are  given  in  Table  4.8. 


Vel  [M] 

[“] 

ex+  [™] 

[ft] 

ey+  [ft] 

0.5 

1443.85 

13.24 

73.89 

0.24 

0.6 

1497.80 

12.96 

75.61 

0.30 

0.7 

1465.79 

18.53 

74.23 

1.21 

0.8 

1481.31 

29.89 

74.34 

1.55 

0.9 

1481.92 

23.63 

75.43 

0.47 

1 

1483.91 

7.11 

74.99 

1.75 

the  unaided  position  estimates’  1-a  values.  The  inclusion  of  the  ground  object’s  altitude 
information  with  a  100  feet  uncertainty,  barely  aids  the  INS. 

Table  4.10  shows  the  effect  of  including  more  accurate  altitude  information.  The 
estimation  accuracy  increases  when  the  information  accuracy  increases,  as  expected.  Un¬ 
fortunately,  this  level  of  accuracy  is  not  readily  available  for  prior  Yp  information,  and  the 
ensuing  increase  in  position  estimation  accuracy  is  not  enough  for  good  INS  aiding. 

As  a  result,  contrary  to  our  expectations,  we  conclude  that  the  inclusion  of  prior  Yp 
information  in  the  estimation  process  does  not  significantly  contribute  to  INS  aiding.  The 
altitude  information  on  the  ground  object,  actually,  is  a  measurement  may  be  obtained  by 
using  the  onboard  sensors;  or,  it  can  be  highly  accurate  if  we  choose  a  point  on  the  surface 
of  the  sea  (altitude  is  very  close  the  zero).  So,  we  do  not  suggest  to  use  this  algorithm  in 
any  aiding  scheme. 
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Table  4.10  Measurement  Situation  2  -  Estimation  performance  as  a  function  of  measure¬ 
ment  errors.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 
The  INS  provided  measurements,  accuracy  is  as  in  Table  4.8. 


dE^[ft/sec] 

at  [ml 
Exq  l  j 

^Ex,  [“] 

[ft] 

=  100  ft 

2.513 

1487.06 

75.69 

1486.84 

100.89 

(7v—  =  50  ft 

2.498 

1483.48 

75.31 

1483.69 

50.41 

(Jy—  =  10  f 

^  P 

2.525 

1478.05 

74.98 

1477.79 

10.00 

Simulation  Results  -  Measurement  Situation  3.  Only  the 

aircraft  velocity  estimate  is  calculated,  since  the  parameter  vector  includes  only  the  velocity 
state  of  the  INS  navigation  output.  The  simulation  results  are  shown  in  Table  4.11  which 
includes  the  statistics  of  the  velocity  estimate  for  varying  altitudes  and  airspeeds.  The 

Table  4.11  Measurement  Situation  3  -  Airspeed  Estimation  performance  for  different 
airspeeds  and  altitudes.  The  measurement  errors  during  the  estimation  pro¬ 
cess  are  criNSe^,^  =  |  deg,  aiNSv  =  2-5  ft/sec,  cfinSx^  =  0-8  NM  (1481.6  m), 
and  (TimSyq  =  75  ft.  The  slant  range  measurement  has  an  1-a  error  of  200  ft. 


h  [ft] 

[ft /sec] 

V  [M] 

1000 

2.479 

2.476 

0.5 

3,000 

2.473 

2.471 

0.6 

6,000 

2.478 

2.542 

0.7 

10,000 

2.445 

2.487 

0.8 

15,000 

2.420 

2.484 

0.9 

20,000 

2.415 

2.528 

1 

estimates’  l-o"  values  are  below  the  pre-aiding  velocity  values;  however,  this  improvement 
is  not  adequate  to  declare  a  successful  aiding.  Another  observation  is  that  the  accuracy 
increases  when  the  altitude  increases.  This  contradicts  the  other  experiments;  however, 
when  the  altitude  gets  higher,  the  slant  range  also  gets  longer,  so  that  the  relative  ranging 
error  decreases,  i.e.,  the  signal-to-noise  ratio  of  the  slant  range  measurement  increases. 

This  scenario  shows  that  the  bearings-only  measurements  supported  by  the  slant 
range  measurement  to  the  ground  object  is  not  effective  on  INS  position  estimate.  Hence, 
we  conclude  that  this  scenario  can  not  be  used  as  a  unique  means  of  aiding  the  INS 
optically. 
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Simulation  Results  -  Measurement  Situation  4-  In  Measure¬ 
ment  Situation  4,  the  effect  of  including  the  prior  information  on  the  altitude  of  the  point 
P  and  the  slant  range  to  the  point  P  measurement  in  the  parameter  estimation  process  is 
investigated  and  is  documented  in  Tables  4.12  through  4.16.  The  estimate  of  the  velocity 
V,  and  the  geo-location  of  point  P  (the  Xp  and  Yp  estimates)  are  shown  in  Table  4.12  as 
a  function  of  altitude,  and  in  Table  4.14  as  a  function  of  airspeed.  Table  4.13  gives  the 
aircraft  position  (Xq  and  Tq)  estimates  for  various  flight  altitudes,  and  Table  4.15  gives 
the  position  statistics  for  different  airspeeds.  Compared  to  the  measurement  Situation  in 
which  only  prior  information  on  the  altitude  of  point  P  is  used,  the  estimates  are  slightly 
better;  however,  the  estimation  accuracy  is  again  determined  by  the  accuracy  of  the  INS 
provided  measurements.  Finally,  in  Table  4.16,  we  show  the  different  measurement  error 
levels,  and  their  statistics.  Using  passive  slant  range  measurement  devices,  and  obtaining  a 
prior  information  on  the  ground  object  altitude,  we  still  perform  position  estimate  without 
radiating  magnetic  energy  and  still  assume  the  ground  object  coordinates  unknown.  From 
this  point  of  view,  this  scenario  could  have  been  proposed  to  use  in  an  INS  aiding  schema, 
if  the  X-position  estimate  had  been  also  improved. 

Table  4.12  Measurement  Situation  4  -  Velocity  estimate  and  geo-location  performance 
for  different  flight  altitudes.  The  A/C’s  speed  is  0.8  M;  and  the  measurement 
errors  during  the  estimation  process  are  ajNSe^j  ~  I  (^iNSy  —  2-5  ft/sec, 
(TinSxq  ~  0-8  NM  (1481.6  m),  and  ct/jvSyq  ~  prior  information 

Yp  and  the  measurement  Rm  have  the  statistics  avp  =  100  ft  and  asr  =  200 


ft. 


h  [ft] 

[ft /sec] 

^Exp  [“] 

e^+  [m] 

^Eyp  [ft] 

ey+  [ft] 

1000 

2.464 

1485.65 

37.07 

99.91 

2.01 

3,000 

2.447 

1492.70 

13.26 

98.72 

0.26 

6,000 

2.546 

1486.65 

1.64 

101.25 

0.99 

10,000 

2.447 

1480.34 

27.69 

100.71 

0.22 

15,000 

2.468 

1493.02 

25.02 

101.15 

2.52 

20,000 

2.448 

1489.25 

19.19 

99.09 

0.89 

4-33 


Table  4.13 


Measurement  Situation  4  -  Own  ship  position  estimation  performance  for 
different  flight  altitudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement 
errors  during  the  estimation  process  are  given  in  Table  4.12. 


h  [ft] 

e^+  [m] 

ey+  [ft] 

[ft] 

1000 

38.67 

1485.29 

0.79 

76.14 

3,000 

13.98 

1492.82 

1.36 

74.53 

6,000 

1.81 

1486.53 

0.49 

75.29 

10,000 

28.08 

1480.12 

0.66 

74.43 

15,000 

26.00 

1492.16 

1.02 

76.20 

20,000 

18.20 

1488.61 

0.10 

74.66 

Table  4.14  Measurement  Situation  4  -  Velocity  estimation  and  geo- location  performance 
for  different  airspeeds.  The  altitude  is  3,000  ft,  and  the  measurement  errors 
during  the  estimation  process  are  ajNSg^^  =  |  deg,  (TjnSv  ~  ft/sec, 
(TinSxq  =0-8  NM  (1481.6  m),  and  (JinSyq  —  ft-  dlde  prior  information 
Yp  and  the  measurement  Rm  have  the  statistics  avp  =  100  ft  and  asr  =  200 


ft 


V  [M] 

^Ev  [ft /sec] 

[“] 

e^+  [m] 

[ft] 

ey+  [ft] 

0.5 

2.462 

1464.74 

2.20 

98.81 

1.17 

0.6 

2.508 

1468.96 

2.84 

100.2 

2.33 

0.7 

2.509 

1465.51 

0.04 

99.94 

1.36 

0.8 

2.503 

1478.13 

12.9 

102.16 

0.75 

0.9 

2.469 

1474.04 

15.11 

101.31 

0.09 

1 

2.512 

1492.95 

6.74 

100.73 

1.82 

Table  4.15  Measurement  Situation  4  -  Own  ship  position  estimation  performance  for 
different  airspeeds.  The  altitude  is  3,000  feet,  and  the  measurement  errors 
during  the  estimation  process  are  given  in  Table  4.14. 


h  [ft] 

%+  [“] 

[“] 

ey+  [ft] 

^Ey,  [ft] 

0.5 

1.17 

1465.07 

1.91 

75.67 

0.6 

1.49 

1468.64 

0.75 

75.88 

0.7 

0.60 

1465.64 

0.32 

73.90 

0.8 

13.81 

1478.27 

0.09 

75.05 

0.9 

14.39 

1473.95 

0.92 

75.07 

1 

7.53 

1492.78 

0.54 

74.08 
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Table  4.16  Measurement  Situation  4  -  Estimation  performance  as  a  function  of  measure¬ 
ment  errors.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 
The  measurements’  accuracy  provided  by  the  INS  are  as  in  Table  4.14. 


^Ev  [ft /sec] 

[“] 

[“] 

[ft] 

Oy-  =  100  ft,  iTp~  =  200  ft 

2.462 

1509.91 

75.09 

1500.42 

97.98 

Oy-  =  50  ft,  Up-  =  100  ft 

2.420 

1494.41 

74.55 

1494.89 

49.29 

Oy-  =  10  ft,  Up-  =  20  ft 

2.338 

1484.73 

74.60 

1484.49 

9.86 

Simulation  Results  -  Measurement  Situation  5.  Simulation 
results  for  the  measurement  Situations  where  the  additional,  Yp,  information  is  included, 
are  shown  in  Tables  4.17  through  4.21.  Tables  4.17  and  4.18  show  the  velocity  estimation 
and  geo-location  results,  and  own-ship  position  estimation  performance  for  varying  flight 
altitudes,  respectively. 


Table  4.17  Measurement  Situation  5  -  Velocity  estimate,  and  geo-location  performance 
for  different  flight  altitudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement 
errors  during  the  estimation  process  are  cjNSg^^  =  |  deg,  (Tjnsv  ~ 
ft/sec,  (TinSxq  ~  0.8  NM  (1481.6  m),  and  (TinSy^  ~  additional 

prior  information  accuracy:  axp  =  cvp  =  100  ft. 


h  [ft] 

^Ey  [ft /sec] 

ft^Xp  [“] 

e^+  [m] 

^hp  [ft] 

ey+  [ft] 

1000 

2.535 

30.34 

0.46 

100.07 

2.35 

3,000 

2.487 

29.87 

0.34 

98.12 

0.31 

6,000 

2.479 

30.88 

0.18 

98.75 

0.25 

10,000 

2.522 

30.38 

0.42 

98.69 

0.17 

15,000 

2.485 

30.35 

0.27 

101.1 

0.13 

20,000 

2.507 

31.01 

0.54 

100.04 

3.18 

It  is  observed  that  the  positioning  performance  in  this  measurement  Situation  is  good 
since  the  resultant  l-o"  value  of  the  A-position  estimate  of  the  A/C  is  reduced  considerably. 
The  estimation  and  geo-location  performance  is  documented  in  Tables  4.19  and  4.20  as 
a  function  of  airspeed.  The  accuracy  of  the  position  estimate  and  of  geo-location  tends 
to  decrease  when  the  velocity  decreases  and/or  the  altitude  increases.  The  statistics  for 
varying  error  levels  of  the  INS-provided  measurements  are  given  in  Table  4.21. 
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Table  4.18  Measurement  Situation  5  -  Own  ship  position  estimation  performance  for 
different  flight  altitudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement 
errors  during  the  estimation  process  are  given  in  Table  4.17. 


h  [ft] 

e^+  [m] 

ftJo  [“] 

ey+  [ft] 

[ft] 

ftyo  [ft] 

1000 

1.88 

34.62 

36.13 

1.36 

74.88 

74.99 

3,000 

1.41 

36.68 

37.42 

0.51 

74.68 

74.99 

6,000 

0.96 

45.66 

44.55 

0.88 

74.86 

74.99 

10,000 

3.64 

71.45 

72.33 

2.33 

75.12 

74.99 

15,000 

3.19 

94.89 

94.72 

0.35 

75.11 

74.99 

20,000 

4.64 

130.46 

127.32 

0.34 

76.47 

74.99 

Table  4.19  Measurement  Situation  5  -  Velocity  estimation  and  geo-location  performance 
for  different  airspeeds.  The  altitude  is  3,000  feet;  and  the  measurement  errors 
during  the  estimation  process  are  ajNSe^-y  ~  |  <^lNSv  —  ft/sec, 
(TinSxq  —  0-^  (1481.6  m),  and  (TjnSyq  —  ft-  additional  prior 

information  accuracy:  axp  =  (^Yp  =  100  ft. 


V  [M] 

ftfiv  [ft /sec] 

[“] 

e^+  [m] 

[ft] 

ey-+  [ft] 

0.5 

2.472 

30.73 

0.04 

100.37 

0.24 

0.6 

2.516 

30.48 

0.74 

100.55 

1.78 

0.7 

2.510 

31.17 

0.13 

99.30 

1.65 

0.8 

2.444 

30.69 

0.02 

99.89 

1.9 

0.9 

2.483 

30.38 

0.34 

98.72 

0.25 

1 

2.495 

30.53 

0.38 

98.83 

1.17 

Measurement  Situation  5  could  be  called  “optical  position  fix-taking”,  because  the 
positioning  performance  is  comparable  to  that  achieved  with  currently  used  fix-taking 
modes,  however  without  ranging.  The  objective  of  this  research,  we  recall,  is  INS  aiding 
by  optically  tracking  an  “unknown”  ground  object.  Now,  the  position  of  the  ground  object 
is  known,  however  no  active  ranging  is  used. 
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Table  4.20  Measurement  Situation  5  -  Own  ship  position  estimation  performance  for 
different  airspeeds.  The  altitude  is  3,000  feet,  and  the  measurement  errors 
during  the  estimation  process  are  given  in  Table  4.19. 


V  [M] 

e^+  [m] 

^Xo  [™] 

ey+  [ft] 

[ft] 

<^10  [ft] 

0.5 

1.30 

39.47 

38.89 

0.72 

74.59 

74.99 

0.6 

0.57 

37.44 

37.26 

1.98 

74.77 

74.99 

0.7 

0.54 

37.96 

38.22 

2.11 

73.58 

74.99 

0.8 

0.67 

37.41 

37.15 

0.78 

76.14 

74.99 

0.9 

1.11 

37.24 

36.88 

1.36 

74.53 

74.99 

1 

1.45 

36.24 

36.41 

1.90 

75.66 

74.99 

Table  4.21  Measurement  Situation  5  -  Estimation  performance  as  a  function  of  prior 
information  accuracy.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M, 
respectively.  The  measurements  provided  by  the  INS  are  given  in  Table  4.19. 


^Ev  [ft/sec] 

[“] 

[ft] 

[“] 

[ft] 

=  100  ft 

Yp  Ap 

2.487 

37.02 

76.95 

30.26 

99.43 

a^~  =  a^-  =  50  ft 

Yp  Ap 

2.509 

37.92 

75.00 

15.16 

50.67 

(jw-  =  (Jv-  =  10  ft 

Yp  Ap 

2.422 

15.96 

73.98 

3.05 

9.97 

Simulation  Results  -  Measurement  Situation  6.  In  Measure¬ 
ment  Situation  6,  we  also  considered  the  case  in  which  the  Xp  information  on  the  point 
P  is  included,  and  re-ran  the  same  experiments.  The  results  are  documented  in  Tables 
4.22,  4.23,  4.24,  and  4.25.  It  can  be  seen  that  the  inclusion  of  the  Xp  prior  information 
yields  a  decent  parameter  estimate  9,  which  is  indicative  of  good  INS  aiding,  although 
some  deviations  are  observed. 

Unfortunately,  this  scenario  needs  additional  measurement  Xp  to  yield  a  good  per¬ 
formance  as  shown  in  the  Tables  4.22  to  4.25.  Inclusion  of  Xp  is  tantamount  to  say  that 
this  scenario  is  only  used  on  the  “known”  ground  object.  Although  we  think  that  it  can 
be  used  during  the  peace-time  flights  on  our  land,  in  any  way,  the  current  methods  of 
fix-taking  are  already  doing  the  same  job,  even  more  accurately.  As  a  result.  Scenario  6 
results  are  favorable,  but  the  Scenario  is  not  the  one  we  try  to  design. 
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Table  4.22  Measurement  Situation  6  -  Velocity  estimation  and  geo-location  performance 
for  different  flight  altitudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement 
errors  during  the  estimation  process  are  cjNSe^j  ~  I  (^iNSy  —  2-5  ft/sec, 
(TinSxq  =0-8  NM  (1481.6  m),  and  ctinSyq  —  ft-  prior  information 
Xp  and  Yf,  and  the  measurement  Rm  have  the  statistics  axp  =  cryp  =  100 
ft.,  and  asr  =  200  ft. 


h  [ft] 

[ft /sec] 

^Exp  [“] 

e^+  [m] 

^hp  [ft] 

ey+  [ft] 

1000 

2.518 

30.67 

0.65 

100.44 

1.32 

3,000 

2.488 

30.85 

0.51 

99.53 

2.22 

6,000 

2.497 

30.38 

0.18 

98.35 

0.62 

10,000 

2.423 

29.98 

0.21 

100.16 

1.17 

15,000 

2.359 

30.46 

0.22 

100.44 

1.91 

20,000 

2.422 

30.37 

0.04 

100.40 

0.41 

Table  4.23  Measurement  Situation  6  -  Own  ship  position  estimation  performance  for 
different  altitudes.  The  A/C’s  speed  is  0.8  M,  and  the  measurement  errors 
during  the  estimation  process  are  given  in  Table  4.22. 


h  [ft] 

^x+  [“] 

[“] 

ftxo  [“] 

ey+  [ft] 

[ft] 

ftfo  [ft] 

1000 

3.11 

35.14 

34.48 

0.07 

76.21 

74.99 

3,000 

2.28 

40.79 

37.15 

0.98 

74.59 

74.99 

6,000 

0.96 

43.68 

44.40 

1.78 

74.49 

74.99 

10,000 

2.08 

58.61 

60.70 

0.09 

74.81 

74.99 

15,000 

0.41 

69.27 

68.82 

0.55 

75.25 

74.99 

20,000 

2.82 

79.70 

78.68 

1.30 

74.87 

74.99 

Table  4.24  Measurement  Situation  6  -  Velocity  estimation  and  geo-location  performance 
for  different  airspeeds.  The  flight  altitude  is  3,000  feet,  and  the  measurement 
errors  during  the  estimation  process  are  ajNSe^j  ~  I  (^iNSy  —  2-5  ft/sec, 
(JinSxq  —  0-8  NM  (1481.6  m),  and  (JinSyq  —  ft-  prior  information 
Xp  and  Yf  accuracy  and  the  measurement  Rm  have  the  statistics  axp  = 
avp  =  100  ft,  and  asR  =  200  ft. 


V  [M] 

^Ev  [ft/®®^] 

^Exp  [“] 

e^+  [m] 

<^Eyp  [ft] 

ey-+  [ft] 

0.5 

2.481 

30.17 

0.91 

99.00 

1.69 

0.6 

2.440 

30.50 

0.31 

98.45 

0.78 

0.7 

2.476 

30.84 

0.04 

99.39 

0.97 

0.8 

2.467 

30.05 

0.82 

99.76 

0.09 

0.9 

2.536 

30.28 

0.27 

98.70 

3.34 

1 

2.505 

30.60 

0.24 

99.28 

0.57 
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Table  4.25  Measurement  Situation  6  -  Own  ship  position  estimation  performance  for 
different  airspeeds.  The  flight  altitude  is  3,000  feet,  and  the  measurement 
errors  during  the  estimation  process  are  given  in  Table  4.24. 


V  [M] 

e^+  [m] 

^Xo  [™] 

ey+  [ft] 

[ft] 

<^10  [ft] 

0.5 

2.05 

38.74 

38.45 

0.004 

73.78 

74.99 

0.6 

1.51 

39.34 

37.21 

0.263 

75.48 

74.99 

0.7 

1.1 

37.55 

36.81 

1.46 

75.41 

74.99 

0.8 

0.38 

37.29 

37.05 

0.72 

75.04 

74.99 

0.9 

0.82 

37.25 

36.39 

0.24 

73.59 

74.99 

1 

0.31 

36.46 

36.31 

0.37 

76.16 

74.99 

Table  4.26  Measurement  Situation  6  -  Estimation  performance  as  a  function  of  mea¬ 
surement  errors.  The  flight  altitude  and  velocity  are  3,000  feet  and  0.8  M, 
respectively.  The  INS  provided  measurements’  accuracy  is  as  in  Table  4.24. 


^Ev  [ft/®®^] 

[“] 

[ft] 

[“] 

[ft] 

Gy-  =  O'X”  ~  ft’  ~  ft 

2.528 

37.22 

75.32 

29.88 

99.3 

Gy-  =  Gy--  =  50  ft,  Gp-  =  100  ft 

2.435 

22.91 

75.41 

15.13 

50.35 

Gy-  =  Gy-  =  10  ft,  Gp-  =  20  ft 

2.067 

14.61 

74.77 

3.04 

10.06 

4. 3. 1.6  Comparison  of  The  Measurement  Situations.  We  inves¬ 
tigate  INS  aiding  by  optically  tracking  an  unknown  ground  object.  Phase  1  entailed  the 
estimation  of  the  angular  navigation  variables.  The  estimation  performance  statistics  of 
the  algorithm  which  is  applied  to  6  different  measurement  scenarios  is  based  on  5000  “inde¬ 
pendent”  MC  runs.  Thus,  in  each  measurement  Situation,  the  random  number  generator 
is  used  to  simulate  white  Gaussian  noises  for  each  measurement.  As  a  result,  different 
samples  of  noises  are  applied  to  each  parameter  in  each  run  and  results  are  documented 
in  Tables  4.4  to  4.26.  Based  on  these  independent  experiments,  we  analyzed  the  statistics 
scenario  by  scenario. 

In  this  section,  we  compare  the  Scenarios’  statistics  parameter-wise.  Fig  4.6  shows 
the  experimental  error  variance  of  own  ship  A-position  estimate.  Measurement  Situations 
3  and  6  are  clearly  preferable  to  Measurement  Situations  2  and  5.  The  estimation  results 
in  Measurement  Situations  3  and  6  reflect  the  Xp  prior  information  accuracy.  In  Measure- 
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ment  Situations  2  and  5,  the  error  variance  of  the  estimates  is  about  0.8  NM,  since  they 
are  driven  by  the  INS  provided  Xq  measurements. 


Altitude  [1 000  It] 

Figure  4.6  Own-ship  X-Position  Estimate:  Comparison  of  Measurement  Situations 

The  comparison  of  geo-location  performance  concerning  the  Xp  coordinate  is  given 
in  Fig  4.7.  The  results  are  similar  to  the  Xq  estimation  performance  results.  Inclusion 
of  prior  information  on  Xp  in  Measurement  Situations  3  and  6  yields  an  estimation  error 
variance  of  about  30  meters. 


Altitude  [1000  ft] 

Figure  4.7  Xp  -  Geo-location:  Comparison  of  Measurement  Situations 

Estimation  error  a  comparisons  for  own  ship  altitude  estimation  are  shown  in  Fig 
4.8.  All  Measurement  Situations  in  this  experiment  include  Yp  prior  information.  The 
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1-a  value  of  the  INS  provided  altitude  measurement  is  75  feet;  and  the  100  feet  accurate 
Vp  prior  information  does  not  affect  the  estimation  performance.  After  aiding,  the  results 
are  random  and  the  errors  are  about  75  feet.  In  Measurement  Situations  5  and  6,  inclusion 
of  slant  range  measurement  slightly  reduces  the  estimation  error. 


Altitude  [1000  ft] 

Figure  4.8  Own-ship  Y-Position  Estimate:  Comparison  of  Measurement  Situations 

The  ground  object  altitude  estimation  errors  are  compared  in  Fig  4.9.  In  Mea¬ 
surement  Situation  1,  the  estimation  error  variance  shows  a  considerable  increase  when 
the  flight  altitude  increases.  This  measurement  Situation  simulates  geo-location  using 
bearings-only  measurements.  Remaining  measurement  Situations  are  driven  by  the  qual¬ 
ity  of  the  prior  information  Yp,  hence  the  100  feet  positioning  error  variance  is  expected. 

The  velocity  estimation  performance  comparison  is  shown  in  Fig  4.10.  The  results 
are  slightly  below  the  unaided  velocity  error  a  of  2.5  ft/sec.  In  Measurement  Situations  4, 
5,  and  6,  the  inclusion  of  slant  range  measurement  decreases  the  error  variance. 

Considering  own-ship  A-position  and  the  ground  object  A-coordinate  estimates,  the 
measurement  Situations  including  Xp  prior  information  clearly  outperforms  the  remaining 
measurement  Situations.  Unfortunately,  the  objective  of  aiding  INS  by  tracking  an  “un¬ 
known”  ground  object  can  not  be  satisfied  in  a  scenario  we  use  Xp  prior  information.  For 
own-ship  Y-position  and  the  ground  object  Y-coordinate  estimates,  inclusion  of  Vp  prior 
information  do  not  improve  the  estimation  performance  unless  the  prior  information  is  very 
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Altitude  [1000  ft] 

Figure  4.9  Yp  -  Geo-location  Estimate:  Comparison  of  Measurement  Situations 

accurate.  Assuming  the  terrain  is  flat  and  the  altitude  of  the  ground  objects  do  not  change 
significantly  within  1  NM,  the  difference  between  onboard  baro- altimeter  and  radar  altime¬ 
ter  may  yield  a  prior  information  on  the  altitude  of  the  ground  object.  Hence,  we  assumed 
100  feet  error  a  for  Yp  prior  information.  For  more  accurate  prior  information,  however, 
we  have  to  assume  that  the  ground  object  coordinates  are  known.  Own-ship  velocity  esti¬ 
mates  results  show  that  optical  tracking  Scenarios  have  not  significant  contribution  to  the 
INS  velocity  estimate  error  reduction. 


Figure  4.10  Velocity  Estimate:  Comparison  of  Measurement  Situations 
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4-3.2  Singular  Linear  Regression.  At  the  completion  of  Phase  1  ,  we 
have  the  estimates 


ID  = 

7  =  AA(7,cj^) 


In  other  words, 


7D  =  jD  +  v-yjy,  v-y^  =  Af{0,a^J 

7  =  7  +  'U7,  =  AA(0,  cr^)  (4.91) 

The  measurement  situation  is  shown  in  Fig  3.2.  We  recognize  that 

X  =  R  cosjo 

y  =  R  sinjD  (4.92) 

where  R  is  the  initial  slant  range  to  the  point  P.  Replacing  in  Eqs.  (4.92)  7/5  with  jd,  and 
using  Eqs  (4.91),  we  obtain 


X  ^  R  cos^D  —  R  sinjD-V'yjy 

y  ^  R  sin^D  +  R  cosjd-V'td 

Furthermore,  we  recall  the  equalities 


x  =  K^V 
y  =  KyV 

where,  the  gains  Kx  and  Ky  obtained  after  the  application  of  the  SVD  algorithm,  are 
“clean” . 

Hence,  we  declare  R  and  V  the  primary  parameters  and  write  the  linear  regression  in  R 
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and  V: 


0 

COSJD 

-K^ 

p  1 

—R  sinjn 

0 

P  1 

-Ky 

R 

+ 

R  COSJD 

V^D 

0 

— 

sinjD 

V 

0 

vv 

0 

1 

0 

1 

We  also  have  the  coordinate  transformation  Equations  (3.1) 


(4.93) 


X  cosj  +  y  sinj  =  Xp  —  Xq 

X  sinj  —  y  cosj  =  Yp  —  Yq  (4.94) 

Inserting  Eqs.  (4.92)  into  the  coordinate  transformation  Equations  (4.94),  we  obtain 

R{cos'yD.cos^  +  sin'jD.sin'y)  =  Xp  —  Xq 
R{cos'yD.sin'y  —  sin'yD.cos'y)  =  Yp  —  Yq 


which  yields 


R  cos{'yD  -  7)  =  Xp  -  Xq 

R  sin{'^D  —  7)  =  Yq  —  Yp  (4.95) 

Eqs.  (4.91)  yield 

7D  -  7  =  7D  -  7  +  '^70  -  "^7 
and  thus,  linearization  yields 

cos{-jD  -  7)  ~  cos{jD  -  7)  -  sin{^D  -  l)v^D  +  sin{^D  -  l)v^ 

sin{'jD  -  7)  ~  sin{^D  -  7)  +  cos{jd  -  i)v^d  “  cos{^d  -  l)v^  (4.96) 
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Inserting  Eqs.  (4.96)  into  Eqs.  (4.95),  we  obtain  the  linear  regression  in  the  complete 
parameter  (R,  Xq,  Yq,  Xp,  Yp): 


cos{^D  -  7) 
sin{^D  -  7) 


1  0 
0  -1 


-1 

0 


“1 

r  R  1 

Xo 

Yo 

Xp 

LTp  J 

-sin{jD  -  7)  sin{^D  -  7) 

V^D 

cos{^D  -  7)  -cos{^D  -  7) 

We  have  the  additional  non-linear  equality  constraint: 


(4.97) 


^/(Xo  -  Xpf  +  (Eo  -  yp)2  -  i?  =  0 

We  treat  the  above  non-linear  equality  constraint  f[X)  =  0,  where  X  =  (i?,  Xq,  Yq,Xp,  Yp) 
and 


f{R,  Xo,  Yo,  Xp,  Yp)  =  R-  V(Xo  -  Xp)2  +  (Eq  -  Yp)^  (4.98) 


as  follows. 

The  linearization  of  Eq.  (4.98)  about  a  prior  parameter  estimate  yields  the  additional 
linear  regression  equation 


0  = 


^(X--X-)2+(Y--Yf)^,  (Xp-Xo),  (Yf-Y^-),  (X^-Xp),  (Y~ -^p) 


R 

Xo 

>0 

Xp 

Yp 


(4.99) 


We  also  perform  the  following  algebraic  manipulations: 
In  Eq.  (4.99)  we  eliminate 
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and  divide  the  equation  by  R  ,  where  the  superscript  denotes  a  prior  estimate  of  the 
parameter.  The  linearization  (4.99)  of  f{X)  =  0  is  developed  in  Appendix  C. 

At  this  point,  we  use  the  INS-provided  measurements  Vm-,  the  linear 

regression  equations  (4.93)  and  (4.98),  and  the  constraint  (4.99)  which  were  derived  so  far, 
and  we  form  the  basic  linear  regression 


■ 

Vm 

0 

0 

0 

0 

0 

-Yom 

Y 

^  Om 

1 

-K, 

-Ky 

0 

0 

0 

0 

0 


0 

COSJD 

siri’jD 

cos{^D  -  l) 
sin{^D  -  7) 

1 

0 

0 


0 

0 

0 

1 

0 


1 

0 


0 

0 

0 

0 

-1 

yp-%~ 

R- 

0 

1 


0 

0 

0 

-1 

0 


0 

0 


0 

0 

0 

0 

1 

^o~-yp~ 

R- 

0 

0 


V 

R 

Xo 

ho 

Xp 

Yp 


10  0  0 

0  0  0  0 

0  0  0  0 

0  0  0  sin{'yD  —  7) 

0  0  0  —cos{^D  —  7) 
0  0  0  0 

0  10  0 

0  0  1  0 


0 


—R  sinjD 
R~cos^£) 
-sin{^D  -  7) 
cosijD  -  7) 

0 

0 

0 


vv 


VXo 


VYo 


(4.100) 


4.3.2. 1  Measurement  Seenarios.  In  Sect.  4.3.2  we  have  obtained  the 
basic  linear  regression  (4.100)  of  the  form 


Z  =  He +  TV 


(4.101) 


Based  on  this  linear  regression,  we  simulate  6  different  measurement  scenarios  whose  deriva¬ 
tions  are  given  as  following. 
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Scenario  1.  In  this  measurement  situation,  we  assume  that  the 
aircraft’s  Xq  and  Yq  position  and  aircraft’s  velocity  are  provided  by  the  INS  with  1-a 
errors  of  0.8  nm,  75  ft,  and  2.5  ft /sec,  respectively. 

The  regressor  H 


and 


Z=[Vm  0  0  0  0  0  Xo, 


1 

0 

0 

0 

0 

0 

0 

0 

0 

—R~  sin^D 

0 

0 

0 

0 

R~  COS^D 

0 

0 

0 

sin{^D  - 

-7) 

-sin{jD  -  7) 

0 

0 

0 

-cos{jD  ■ 

-7) 

cos{^D  -  7) 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

1 

0 

0 

(4.103) 
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The  8x8  equation  error  covariance  matrix  R  =  E\TVV'^T'^'\  is 

0-^  0  0  0  0 

0  0  0  0 
R  =  T  {)  0  0  0  r'^  (4.104) 

0  0  0  cj2  0 

_  0  0  0  0  cj2^_ 

R  has  a  rank  of  5. 

Obviously,  we  need  to  iterate  on  Yq)  ^p-,  and  R.  The  initial  guesses  for  the  above  are 
Fq“  =  Yom,  Yp  =  0.  Considering  optimal  measurement  geometry  introduced  in  Sect.  4.1, 
initial  guess  for  the  slant  range  measurement  can  be  chosen  as  R~  =  |x  altitude. 

Eqs.  (4.138)  -  (4.141)  in  the  sequel  yield  the  MV  estimate  and  predicted  estimation  error 
variance  matrix.  INS  aiding  and  geo-location  are  jointly  performed. 

Scenario  2.  In  this  measurement  scenario,  the  linear  regression  is 
augmented  with  the  prior  information  on  Yp,  with  ayp  =  100  ft.  Thus,  we  include  the 
“measurement” 

Yp^  =Yp  +  VYp  (4.105) 
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We  obtain  the  augmented  linear  regression  (4.101),  where  the  regressor 


H  = 


1 

-K^ 

-Ky 

0 
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0 
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0 

cos^D 
sin^D 
cos{jD  -  7) 
sin(7D  -  7) 

1 

0 

0 

0 


0 

0 

0 

1 

0 


1 

0 

0 


0 

0 

0 

0 

-1 

R- 

0 
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0 

0 

0 

-1 
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0 
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0 

0 

0 

0 

1 


(4.106) 
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V  = 


vv 

VXo 

VYo 

V^D 

VYp 


(4.107) 


The  9x9  equation  error  covariance  matrix  R  is 


R  =  T 


0 

0 

0 

0 
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a 


0 

2 

Xo 

0 

0 

0 
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Yo 
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(4.108) 
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and  the  rank  of  R  is  6. 


Scenario  3.  We  augment  the  linear  regression  by  including  the  slant 
range  to  the  point  P  measurement.  The  new  measurement  equation  is 

Rm  =  R  -\-  vr  (4.109) 


where  I-ur  is  200  feet. 

In  the  augmented  linear  regression  (4.101)  the  regressor 


and 
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The  9x9  equation  error  covariance  matrix  R  is 


R  =  T 


a 


V 
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Xo 
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Yo 
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and  rank(R)=6. 


(4.112) 


Scenario  4-  In  this  measurement  scenario,  we  assume  that  both 
the  altitude  prior  information  and  slant  range  measurement  are  available.  Augmenting 
the  linear  regression  by  including  the  slant  range  and  Yp  information,  we  obtain  for  the 
measurement  situation  4  the  singular  linear  regression  (4.101)  with  the  regressor 
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(4.113) 
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The  10  X  10  equation  error  covariance  matrix  R  is 
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(4.115) 


and  rank(R)=7. 


Scenario  5.  In  this  measurement  scenario,  we  augment  the  linear 
regression  by  including  the  complete  prior  information  on  the  ground  object.  Thus,  the 
“measurement”  equations  are  included 


Yp^ 

=  Yp  +  VYp 

(4.116) 

=  Xp  +  vxp 

(4.117) 
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where  ayp  =  crxp  =  100  ft. 

In  the  augmented  linear  regression  (4.101)  for  the  measurement  situation  5,  the  regressor 
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(4.119) 
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The  10  X  10  equation  error  covariance  matrix  is 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0-^^  0  0  0  0 

R  =  T  0  0  Ocj^o  0  or^  (4.120) 

0  0  0  0  0-2^  0  0 

0  0  0  0  0  0 
0  0  0  0  0  0 

and  rank(R)=7. 

Scenario  6.  The  prior  information  on  the  ground  object’s  position 
{Xp  and  Yp)  and  the  slant  range  measurement  R  are  augmented  into  the  linear  regression. 
Their  1-cj  error  values  are  as  in  the  previously  discussed  Scenarios  4  and  5. 

In  the  augmented  linear  regression  (4.101)  for  the  measurement  situation  6,  the  regressor 
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(4.122) 


The  11  X  11  equation  error  covariance  matrix  is 
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(4.123) 


and  rank(R)=8. 


4 -3. 2. 2  Solution  to  Singular  Linear  Regression.  The  6  linear  regres¬ 
sions  of  the  form  (4.101)  for  Scenarios  1-6  have  an  equation  error  matrix  R  which  is  rank 
deficient.  We  henceforth  refer  to  the  linear  regressions  (4.102)-(4.104),  (4.106)-(4.108), 
(4.110)-(4.112),  (4.113)-(4.115),  (4.118)-(4.120),  (4.121)-(4.123)  for  the  measurement  Sce¬ 
narios  1-6,  respectively,  as  singular.  The  solution  of  singular  linear  regressions  requires  the 
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following 

Theorem  7 

Consider  a  singular  linear  regression  in  the  standard  form 

Z  =  He  +  TV  (4.124) 

where  the  parameter  vector  6  G  7^”,  the  measurement  vector  Z  G  TZ^ ,  H  is  a  N  x  n 
regressor  matrix  of  rank  n,  N  >  n,  and  F  is  an  x  ^  noise  input  matrix.  The  Gaus¬ 
sian  random  noise  vector  V  G  with  statistics  V  =  Af(0,Ri),  and  the  equation  error 
covariance  matrix 


R  =  E{(TV)(TVy}  =  TE{VV^)T^  =  TRiT 


The  N  X  N  error  covariance  matrix  R>0,  and  R  ^  0.  Assume  that 

rank(i?)=m  and  N  —  n  <  m  <  N 

The  MV  parameter  estimate  is  then  given  by 
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-1 


HhiHyl 
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The  parameter  9  is  partitioned  9  =  (g^))  the  matrices  Hi  i,  -^1,2,  -^2,1;  -f^2,2  and  the 
orthogonal  matrix  D  are  specified  in  Eqs.  (4.132),  (4.128),  (4.134),  (4.131)  and  (4.125), 
respectively. 

PROOF 


1.  Perform  the  Singular  Value  Decomposition  [1]  (SVD)  of  the  real  symmetric  positive 
semidefinite  matrix  R. 


R  =  TST^ 


where  T  is  an  V  x  orthonormal  matrix,  S  is  diagonal 

D  :  0 


5  = 


0  :  0 


(4.125) 


and  D  is  also  diagonal.  D  is  an  m  x  m  diagonal  sub-matrix  of  S,  with  positive 
elements.  Thus, 


\D2  :  0 


Dh  : 

0 

: 

0 

D5 

R  =  T 

0  : 

0 

0  : 

0 

=  T 

0 

2.  Define  the  Gaussian  random  vector  W  G  , 


W  = 


D-l 


0  :  Ijv-r 


T^rv 


(4.126) 
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We  calculate 


eI  ww^  [  = 


D-5 


1 

D-2 


D-5 


iN-m 

0 


t'^eI  tvv^t^ 


1 

d-2 


D  2  :  0 


LN-m 


t'^rt 


0 

In-tu 

0 

•  In—tti 

D-l 

0 

: 

0 

D5 

:  0 

tTr 

tTr 

0 

In—tti 

0  : 

0 

0 

:  0 

D- 


0  :  In-t 


0  \  \  D  :  0  Z)  2 


0  :  In-tu  0:0  0  :  In- 


0 


0  :  0 
Hence,  we  conclude  that 


Wl 


W  = 


0 


where 


Wl  € 


and 


Wl  =  Af(0,lm) 
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toll-* 


3.  Multiply  the  linear  regression  (4.124)  from  the  left  by  the  matrix 

0 


0  :  In-t 


Ti 


Thus,  we  obtain 


D-5 

:  0 

D-5 

:  0 

t'^z  = 

0 

1 

S 

1 

0 

•  iN—m 

T^H9  +  W 


Define  the  partitioned  vector 


= 


zi 


Z2 


and  the  partitioned  matrix 


T'^H  = 


Hi 


Ho 


(4.127) 


(4.128) 


where  zi  G  7?.™',  Z2  G  Hi  is  an  m  x  n  matrix,  and  H2  is  an  {N  —  m)  x  n 

matrix. 

Hence,  we  have  obtained  the  reduced  order  non-singular  standard  linear  regression 


D  2  zi  =  D  ^Hi9  +  wi,  E\^wiWi"^  = 

and  a  set  oi  N  —  m  linear  equality  constraints 

Z2  =  H2e 


(4.129) 


(4.130) 
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4.  Without  loss  of  generality,  partition  H2  as  follows: 


H2 


H2,1-  ^2,2 


where  i/2,2  is  an  (N  —  m)  x  {N  —  m)  non-singular  matrix. 
Similarly,  partition  the  vector 


e 


Oi 

O2 


where  62  G  ™ 


With  this  notation,  the  linear  system  (4.130)  is 


(4.131) 


(4.132) 


Z2  =  H2^l6l  +  i^2,202 


and,  backing  out  62,  we  obtain 


02  =  H:^^Z2  -  H:^lH2^ei 


'2,2" 


(4.133) 


5.  Similar  to  H2,  partition  Hi  as  follows 


Hi  = 


Hi^il  Hi, 2 


(4.134) 


where  Hi,i  is  an  m  x  (n  -|-  m  —  N)  matrix,  and  Hi, 2  is  an  m  x  (N  —  m)  matrix. 
Thus,  the  linear  regression  (4.129)  is 


zi  =  Hi,i6i  +  Hi, 262  +  D^wi 


(4.135) 


Inserting  Eq.  (4.133)  into  Eq.  (4.135)  yields  the  reduced  linear  regression 


-  Hi,2H^lz2  =  {Hi,i  -  Hi,2H^^H2,i)  01  +  D^wi 


-1  ; 


(4.136) 


H 


V 
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where  the  equation  error  matrix  is 


R  =  E{D'2wiwJ^D2}  =  D 


(4.137) 


6.  Finally,  assume  that 

rank{Hi^i  —  Hi2H2\H2^i)  =  n  +  m  —  N 

and  apply  the  standard  MV  estimation  formulae  (4.16)  and  (4.17)  to  the  linear 
regression  (4.136) 

We  obtain 


01  =  PeAHi,i  -  Hi^2H2^^H2,ifDHzi  -  T/psT/a” 


(4.138) 


where 


P9,= 


(77i,i  -  Hi,2H2iH2,ifD-\Hi,i  -  Hi^2H2^^H2 


-1  ; 


-1 


(4.139) 


Using  Eq.  (4.133),  obtain 


62  =  H2^Z2  -  H2^1H2,1  I  (i7l,l  -  Fi,2F2-2'772,i)"  -  Hi^2H2^^H2, 

(77i,i  -  Hi^2H2lH2,i)^ D~\zi  -  Hi^2H2lz2)  (4.140) 


-1 


and 


P92  —  -^2,2 -^2,1 


(Fi,i  -  771,2772(2^2,1)'  ^“'(^1,1  -  77i,2  772-2'772, 


-1 


T  fu-UT 


■HUP2, 


(4.141) 


□ 


The  above  derivation  is  summarized  in  the  following  algorithm. 
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SINGULAR  LINEAR  REGRESSION  ALGORITHM 

Gonsider  the  singular  linear  regression  (4.124).  Assume  n  <  N  and  N  >m>N  —  n>0. 

1.  Perform  the  SVD  of  R  and  obtain  the  N  x  N  orthonormal  matrix  T  and  m  x  m 
diagonal  matrix  D  with  positive  elements. 

2.  Form  the  vectors  zi,  Z2,  and  the  matrices  Hi  i,  H12,  H2^i,  and  Ll2,2  as  in  Eqs. 
(4.127),  (4.128),  (4.134),  and  (4.131). 

Assume 

rank{H2^2)  =  N  —  m 
rank{Hi^i  —  iLi^2^^^2-^2,i)  =  n  +  m  —  N 


3.  The  MV  parameter  estimate  and  estimation  error  covariance  are  given  by  formulae 
(4.138)  -  (4.141). 


□ 


4 -3. 2. 3  Simulation  Results.  The  number  of  bearing  measurements  N 
is  10.  For  each  of  the  Scenarios  1-6,  Nmc  =  5000  MG  runs  are  performed.  The  following 
statistics  are  obtained: 

The  experimentally  obtained  mean  error  (bias)  in  the  parameter  estimate  9  (after  aiding) 
is 


^0+  — 


Nmc 


E 


(4.142) 


where  Of  is  the  parameter  estimate  in  the  i  th  MG  experiment. 

The  experimentally  obtained  standard  deviation  of  the  parameter  estimate  (after  aiding) 
is  calculated  according  to 


(4.143) 
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The  predicted  parameter  estimation  error  variance  (after  aiding)  is 


a 


+ 

e 


(4.144) 


Finally,  the  experimentally  obtained  probability  of  the  i-th  parameter  component  estimate 
being  within  a  l-ci  distance  from  the  true  parameter  is  calculated  as  follows. 


Pe, 


—  (T 


Number  of  times 


Nmc 


(4.145) 


Scenario  1.  The  statistics  for  Scenario  1  as  a  function  of  altitude  and 
airspeed,  respectively,  are  shown  in  Tables  4.27  and  4.28.  It  is  observed  that  the  estimation 
performance  is  completely  dependent  on  the  accuracy  of  the  measurement  provided  by  the 
(unaided)  INS.  Thus,  the  own-ship  position  estimates  Xq  and  are  very  close  to  the 
unaided  values  of  these  parameters  {X^  and  Tq”),  and  the  predicted  estimation  error 
variances  of  Xq  and  are  close  to  the  measurement  error  variances  of  the  (unaided) 
INS.  This  means  that  there  is  no  significant  improvement  in  own-ship  position  estimate 
accuracy.  Moreover,  the  positional  estimation  accuracy  is  directly  reflected  in  geo-location 
performance;  that  is,  geo-location  accuracy  is  as  good  as  the  unaided  INS  provided  position 
accuracy.  The  aircraft  altitude  estimate’s  accuracy  decreases  when  the  flight  altitude 
increases,  whereas  the  predicted  altitude  estimation  error  variance  does  not  increase.  It 
means  that  altitude  estimation  performance  in  measurement  Scenario  1  is  poor.  The  same 
applies  to  slant  range  to  the  point  P  estimation  accuracy,  even  though  the  predicted  and 
experimental  estimation  error  variance  errors  are  close,  which  is  good.  The  active  Air-to- 
Ground  Ranging  (AGR)  modes  that  are  currently  used  for  slant  range  estimation  yield 
better  accuracy,  as  required  for  air-to-ground  delivery. 

Similarly,  the  aircraft’s  velocity  estimate’s  standard  deviation  variance  in  all  flight 
conditions  is  about  2.5  feet/sec.  This  is  equal  to  the  value  prior  to  aiding.  Gontrary 
to  the  trend  brought  about  by  altitude  increase,  any  increase  in  the  aircraft’s  velocity 
renders  the  estimates  Yp  and  R  more  accurate;  but  even  at  the  best  flight  condition. 
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Table  4.27  Estimation  performance  as  a  function  of  altitude  -  Scenario  1. 


h  [ft] 

1000 

3,000 

6,000 

10,000 

15,000 

20,000 

®i>+ 

0.008 

0.043 

0.226 

1.769 

7.974 

0.04 

V 

2.458 

2.518 

2.508 

2.469 

2.476 

2.532 

[ft  /  sec] 

2.499 

2.499 

2.499 

2.498 

2.488 

2.499 

0.845 

0.834 

0.86 

0.957 

1.0 

0.839 

C  ■Y+ 

0.01 

0.008 

0.028 

0.011 

0.007 

0.009 

^0 

1480.7 

1496.8 

1484.4 

1464.5 

1488.1 

1484.9 

[m] 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

Pe,.. 

0.845 

0.836 

0.83 

0.835 

0.837 

0.834 

€^'y  + 

^0 

0.201 

1.379 

1.471 

0.708 

0.228 

0.441 

To 

76.88 

75.67 

76.07 

74.95 

74.7 

75.49 

[ft] 

75 

75 

75 

75 

75 

75 

Pei-^ 

0.838 

0.83 

0.837 

0.84 

0.839 

0.838 

®x+ 

9.834 

7.57 

27.77 

0.62 

63.24 

8.06 

Xp 

1480.7 

1496.7 

1484.3 

1464.7 

1487.9 

1485.1 

[m] 

1481.6 

1481.6 

1481.6 

1481.7 

1481.8 

1481.9 

Pei-^ 

0.845 

0.836 

0.83 

0.837 

0.849 

0.832 

^  p 

0.172 

1.241 

3.036 

24.43 

156.3 

4.03 

Vp 

77.07 

78.49 

84.02 

105.54 

125.05 

189.32 

[ft] 

75.06 

75.59 

77.31 

81.2 

88.18 

97.29 

Pei-^ 

0.833 

0.831 

0.816 

0.7 

0.296 

0.687 

®i?.+ 

0.03 

0.41 

3.67 

45.24 

278.5 

6.06 

R 

8.16 

24.29 

45.79 

78.02 

103.2 

165.1 

[ft] 

7.99 

22.16 

39.9 

62.36 

85.45 

121.02 

Pei-^ 

0.834 

0.827 

0.823 

0.914 

0.99 

0.779 
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the  achieved  accuracy  is  close  the  unaided  accuracy.  In  all  experiments,  the  empirically 
obtained  probability  of  the  estimates  falling  within  a  predicted  1-a  of  the  true  parameters 
is  above  80  %. 

In  conclusion,  Scenario  1  represents  the  basic  measurement  situation  which  relies 
on  passive  measurements  only,  does  not  use  and/or  require  the  ground  object’s  position 
and  additional  range  measurement,  and  no  electro-magnetic  energy  is  transmitted  and/or 
received.  An  improvement  in  aircraft’s  angular  navigation  variables  estimates  is  obtained. 
However,  as  for  the  positional  navigation  variables,  this  tactically  advantageous  measure¬ 
ment  scenario  does  not  yield  good  INS  aiding. 

Scenario  2.  The  estimation  performance  in  measurement  Scenario 
2  as  a  function  of  altitude  is  documented  in  Table  4.29  ,  and  as  a  function  of  airspeed 
in  Table  4.30.  We  expect  to  observe  an  enhancement  in  estimation  performance  because 
of  the  inclusion  of  prior  information  on  the  altitude  of  the  ground  object.  Indeed,  the 
estimate  Yp  has  an  experimental  a  of  60  feet,  although  the  uncertainty  in  the  prior 
information  is  100  feet.  The  own-ship  altitude  estimate  Ig  is  also  improved,  e.g.,  we 
obtain  an  experimental  l-ci  of  60  feet  versus  the  pre-aiding  a  of  75  feet.  Enhancements  in 
the  estimation  accuracy  of  V,  Xq  and  Xp  are  not  significant.  The  slant  range  to  the  point 
P  estimation  performance  is  better  than  in  Scenario  1;  however,  its  accuracy  is  still  not 
comparable  to  the  AGR  modes’  accuracy.  As  before,  an  increase  in  velocity  and/or  decrease 
in  altitude  result  in  better  estimation  performance.  Moreover,  the  Yp  and  R  estimation 
performance  deterioration  induced  by  an  increase  in  altitude  is  now  mitigated.  Contrary 
to  previous  observations  however,  an  increase  in  altitude  and/or  decrease  in  the  aircraft’s 
velocity  make  the  estimation  performance  slightly  more  accurate  than  other  parameters’ 
estimation  accuracy. 

The  effect  of  inclusion  of  more  accurate  Yp  information  is  analyzed  in  Table  4.31. 
The  accuracy  of  the  ground  object’s  prior  altitude  information  does  not  have  a  significant 
effect  on  the  Y"*",  Xq,  Xp,  and  estimates.  The  estimation  performance  of  and  Yp  , 
however,  reflects  the  accuracy  afforded  by  the  augmented  measurement. 
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Table  4.29  Estimation  performance  as  a  function  of  altitude  -  Scenario  2. 


h  [ft] 

1000 

3,000 

6,000 

10,000 

15,000 

20,000 

V 

[ft  /  sec] 

0.0002 

0.026 

0.025 

0.04 

0.016 

0.026 

2.502 

2.518 

2.466 

2.414 

2.395 

2.45 

2.499 

2.493 

2.472 

2.426 

2.344 

2.232 

0.842 

0.828 

0.841 

0.847 

0.836 

0.817 

Xo 

[m] 

^x+ 

15.64 

30.07 

0.78 

3.06 

1.15 

10.05 

1471.1 

1481.1 

1482.2 

1447.6 

1479.3 

1462.2 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

0.847 

0.839 

0.84 

0.84 

0.838 

0.844 

do 

[ft] 

0.433 

1.386 

0.255 

1.218 

1.66 

0.454 

60.74 

61.68 

60.66 

64.21 

68.65 

74.27 

60.01 

60.09 

60.37 

60.97 

62.00 

63.32 

Pe,.. 

0.836 

0.828 

0.843 

0.831 

0.807 

0.803 

Xp 

[m] 

29.18 

8.67 

1.04 

3.29 

0.98 

10.33 

^Exj, 

1518.1 

1567.8 

1482.3 

1447.5 

1479.4 

1463.1 

1481.6 

1481.6 

1481.6 

1481.7 

1481.7 

1481.8 

Pei-^ 

0.847 

0.839 

0.841 

0.842 

0.837 

0.844 

Yp 

[ft] 

c-^+ 

^  p 

0.425 

1.479 

0.361 

2.19 

2.238 

0.247 

60.72 

62.65 

63.66 

72.94 

83.25 

95.97 

60.03 

60.3 

61.16 

63.04 

66.13 

69.97 

Pei-^ 

0.837 

0.823 

0.833 

0.798 

0.778 

0.765 

R 

[ft] 

®R+ 

0.022 

0.013 

0.94 

2.27 

0.66 

0.61 

^Er 

8.33 

24.95 

42.8 

68.13 

90.94 

115.2 

7.99 

22.09 

39.49 

60.48 

82.77 

105.72 

Pei-^ 

0.831 

0.81 

0.834 

0.823 

0.81 

0.82 

In  conclusion,  the  inclusion  of  prior  information  on  the  ground  object’s  altitude  does 
not  significantly  help  INS  aiding.  Note  however  that  in  Scenario  2,  we  are  still  exclusively 
using  passive  measurements  only,  and  we  still  assume  the  ground  object’s  position  is  un¬ 
known.  Hence,  the  main  advantage  achieved  in  Scenario  2  compared  to  Scenario  1  is  an 
improvement  in  the  Iq  and  Yp  estimates. 
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Table  4.30  Estimation  performance  as  a  function  of  airspeed  -  Scenario  2. 


Vel  [M] 

0.5 

0.6 

0.7 

0.8 

0.9 

1.0 

^v+ 

0.029 

0.017 

0.027 

0.011 

0.054 

0.014 

V 

2.494 

2.462 

2.519 

2.527 

2.508 

2.49 

[ft  /  sec] 

2.482 

2.487 

2.49 

2.493 

2.494 

2.496 

0.836 

0.84 

0.84 

0.838 

0.845 

0.844 

6 

12.54 

5.71 

8.0 

22.43 

15.63 

6.33 

^0 

^Xq 

1472.6 

1468.6 

1498.2 

1502.2 

1495.4 

1469.6 

[m] 

1481.59 

1481.56 

1481.59 

1481.59 

1481.56 

1481.59 

0.841 

0.843 

0.841 

0.833 

0.839 

0.847 

6'^+ 

-^0 

0.42 

1.547 

0.966 

0.246 

0.804 

1.07 

To 

at 

Evn 

60.14 

61.09 

60.87 

60.05 

60.18 

59.82 

[ft] 

60.24 

60.17 

60.12 

60.09 

60.07 

60.06 

0.842 

0.834 

0.844 

0.845 

0.841 

0.835 

^x+ 

6.19 

12.91 

31.18 

7.86 

40.12 

19.33 

Xp 

^Ex^ 

1535.6 

1526.4 

1583.3 

1545.7 

1599.0 

1503.3 

[m] 

1481.63 

1481.58 

1481.61 

1481.61 

1481.59 

1481.6 

Pei-^ 

0.841 

0.843 

0.842 

0.833 

0.841 

0.848 

6'^+ 

^  p 

0.254 

1.191 

1.205 

0.786 

.374 

0.892 

Yp 

61.33 

61.95 

61.71 

61.52 

60.77 

60.64 

[ft] 

60.75 

60.53 

60.39 

60.29 

60.23 

60.19 

Pei-^ 

0.841 

0.832 

0.842 

0.831 

0.836 

0.836 

^R+ 

0.253 

0.382 

0.327 

0.487 

0.586 

0.161 

R 

37.23 

30.66 

27.8 

24.9 

21.93 

19.41 

[ft] 

35.15 

29.46 

25.18 

22.06 

19.62 

17.68 

Pei-^ 

0.826 

0.824 

0.817 

0.816 

0.82 

0.812 

Table  4.31  Estimation  performance  as  a  function  of  different  measurement  errors  -  Sce¬ 
nario  2.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 


[ft /sec] 

[“] 

[ft] 

[“] 

[ft] 

^^^[ft] 

(Tv-  =  (Ty-  =  100  ft 

Yp  Xp 

2.47 

1472.6 

58.84 

1529.1 

59.78 

24.41 

(Tv-  =  (Tv-  =  50  ft 

Yp  Xp 

2.41 

1468.6 

43.59 

1535.4 

41.72 

24.10 

(Tv-  =  (Tv-  —  10  ft 

Yp  Xp 

2.46 

1475.7 

22.4 

1562.1 

9.91 

24.18 
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Scenario  3.  In  this  scenario,  we  expect  an  enhancement  in  estima¬ 
tion  accuracy  since  we  include  the  slant  range  to  point  P  measurement  in  the  estimation 
process.  Table  4.32  shows  the  estimation  performance  in  Scenario  3  as  a  function  of  flight 
altitude.  The  predicted  estimation  error  variance  of  the  Xq,  and  1q  estimates  are  equal 
to  the  “measurement”  error  variance  of  the  INS  provided  measurements  because  these  pa¬ 
rameters  are  uncorrelated  with  the  slant  range  parameter.  Their  experimental  variances 
are  driven  by  the  unaided  INS  accuracy.  The  estimation  accuracy  of  Yp  is  determined  by 
the  accuracy  of  Tg^  at  low  altitudes;  it  deteriorates  as  the  altitude  increases.  The  velocity 
estimates  are  slightly  more  accurate  at  the  higher  altitudes.  The  slant  range  measurement 
makes  almost  no  difference  in  the  slant  range  to  the  target  estimate  at  lower  altitudes, 
however  it  yields  a  lightly  better  estimate  at  higher  altitudes. 

The  estimation  performance  in  Scenario  3  as  a  function  of  airspeed  is  investigated  in 
Table  4.33.  The  predicted  variance  of  the  parameter  vector  0  estimation  error  decreases, 
which  results  from  an  increase  in  airspeed.  The  velocity  estimation  performance  shows  an 
opposite  trend:  the  higher  the  airspeed,  the  lower  the  predicted  and  experimental  velocity 
estimation  error  variance.  The  results  of  the  experiments  performed  for  different  airspeeds 
are  similar  to  the  altitude  results. 

The  enhancement  of  the  estimation  performance  when  a  more  accurate  slant  range 
measurement  is  used  is  evident  in  Table  4.34.  The  velocity  estimates  are  improved  sig¬ 
nificantly.  The  other  parameters’  estimates  also  improve,  but  not  significantly.  In  both 
the  changing  altitude  and  velocity  cases,  the  probability  of  the  parameter  estimation  error 
falling  within  a  l-predicted-u  is  higher  than  80%. 

We  conclude  that  in  the  measurement  situation  at  hand  in  which  the  position  and 
altitude  of  the  ground  object  are  not  known,  the  inclusion  of  the  slant  range  to  the  ground 
object  measurement  in  the  estimation  process  does  not  result  in  a  significant  improvement 
in  positional  navigation  variable  estimate  and  geo-location  performance. 
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Table  4.32  Estimation  performance  as  a  function  of  altitude  -  Scenario  3. 


h  [ft] 

1000 

3,000 

6,000 

10,000 

15,000 

20,000 

®i>+ 

0.019 

0.0016 

0.012 

0.01 

0.023 

0.038 

V 

2.530 

2.484 

2.444 

2.389 

2.337 

2.199 

[ft  /  sec] 

2.498 

2.484 

2.452 

2.386 

2.287 

2.153 

0.832 

0.841 

0.839 

0.843 

0.836 

0.836 

C  ■Y+ 

15.69 

1.18 

35.29 

13.91 

0.19 

23.82 

^0 

1506.6 

1458.1 

1481.2 

1473.3 

1481.7 

1468.1 

[m] 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

Pe,.. 

0.844 

0.839 

0.83 

0.84 

0.839 

0.842 

€^'y  + 

^0 

2.195 

1.724 

0.143 

0.215 

0.371 

0.136 

To 

75.42 

75.46 

74.91 

75.46 

75.7 

74.55 

[ft] 

75 

75 

75 

75 

75 

75 

Pei-^ 

0.834 

0.848 

0.846 

0.839 

0.83 

0.84 

®x+ 

15.69 

0.682 

34.89 

12.78 

0.32 

23.99 

Xp 

1506.7 

1458.6 

1481.4 

1474.7 

1481.8 

1468.8 

[m] 

1481.6 

1481.6 

1481.6 

1481.7 

1481.7 

1481.8 

Pei-^ 

0.844 

0.839 

0.83 

0.84 

0.839 

0.84 

^  p 

2.29 

1.697 

0.359 

1.88 

2.27 

3.3 

Vp 

75.68 

78.18 

83.32 

100.58 

124.1 

150.5 

[ft] 

75.06 

75.57 

77.22 

80.73 

86.34 

92.57 

Pei-^ 

0.833 

0.837 

0.823 

0.783 

0.754 

0.725 

®i?.+ 

0.032 

0.05 

0.05 

1.59 

2.13 

1.48 

R 

8.38 

24.91 

43.14 

69.21 

94.11 

118.96 

[ft] 

7.99 

22.07 

39.11 

59.73 

80.69 

101.64 

Pei-^ 

0.827 

0.815 

0.819 

0.813 

0.812 

0.807 
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Table  4.33  Estimation  performance  as  a  function  of  airspeed  -  Scenario  3. 


Vel  [M]  0.5 

0.6 

0.7 

0.8 

0.9 

1.0 

V 

[ft  /  sec] 

^v+ 

0.002 

0.016 

0.003 

0.021 

0.063 

0.018 

2.44 

2.492 

2.509 

2.506 

2.475 

2.495 

2.461 

2.473 

2.48 

2.484 

2.488 

2.49 

0.84 

0.841 

0.837 

0.842 

0.834 

0.845 

^0 

[m] 

^x+ 

23.18 

10.05 

4.55 

8.15 

5.38 

28.0 

1499.6 

1479.5 

1478.6 

1465.0 

1488.9 

1465.1 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

Pei-„ 

0.834 

0.845 

0.845 

0.84 

0.838 

0.841 

[ft] 

6'^+ 

0.486 

0.996 

0.46 

2.324 

0.1 

0.704 

73.72 

74.87 

74.43 

75.41 

73.93 

74.23 

75 

75 

75 

75 

75 

75 

Pe,.. 

0.841 

0.842 

0.837 

0.851 

0.841 

0.836 

Xp 

[m] 

^x+ 

21.56 

13.04 

3.12 

5.89 

4.743 

27.86 

^Ex^ 

1502.5 

1493.1 

1481.3 

1471.5 

1489.0 

1465.2 

1481.6 

1481.6 

1481.6 

1481.6 

1481.6 

1481.6 

Pei-^ 

0.833 

0.845 

0.845 

0.839 

0.839 

0.841 

Yp 

[ft] 

6'^+ 

^  p 

0.89 

0.638 

0.198 

2.097 

0.058 

0.926 

^Ey, 

77.46 

77.81 

77.44 

78.3 

76.28 

76.06 

76.45 

76.01 

75.75 

75.58 

75.46 

75.37 

Pei-^ 

0.834 

0.834 

0.831 

0.841 

0.838 

0.829 

R 

[ft] 

^R+ 

0.047 

0.024 

0.062 

0.263 

0.306 

0.388 

4. 

36.82 

31.04 

27.89 

24.8 

21.72 

19.42 

34.95 

29.3 

25.06 

22.06 

19.61 

17.67 

Pei-^ 

0.829 

0.829 

0.813 

0.821 

0.809 

0.823 

Table  4.34  Estimation  performance  as  a  function  of  different  measurement  errors  -  Sce¬ 
nario  3.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 


[ft /sec] 

[“] 

^Ey,  [ft] 

[“] 

[ft] 

ftE«[ft] 

ap--  =  200  ft 

2.464 

1502.2 

72.22 

1502.4 

75.37 

24.29 

1 

II 

o 

o 

2.422 

1495.5 

73.61 

1496.2 

76.2 

23.91 

! 

II 

to 

o 

1.79 

1469.64 

72.66 

1522.7 

74.72 

15.25 
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Scenario  4-  The  estimation  performance  statistics  for  Scenario  4 
are  given  in  Tables  4.35,  4.36,  and  4.37.  A  general  observation  concerning  these  results 
is  that  the  inclusion  of  the  prior  altitude  information  on  the  ground  object  and  the  slant 
range  measurement  yield  estimation  performance  consistent  with  the  advantages  of  both 
measurement  Scenarios  2  and  3.  The  75  feet  1-a  own-ship  altitude  error  is  reduced  to 
60  feet.  The  A-position  estimate  of  the  aircraft  has  still  the  same  deviation  from  the 
true  A-position  as  in  the  unaided  case.  The  estimation  accuracy  of  Ap  closely  tracks  the 
estimation  accuracy  of  Aq.  The  velocity  estimate  stays  unchanged.  The  ground  object 
altitude  estimate  Yp  shows  an  improvement  similar  to  that  of  ,  and  the  slant  range  to 
the  ground  object  estimate  also  improves. 


Table  4.35  Estimation  performance  as  a  function  of  altitude  -  Scenario  4. 


h  [ft] 

1000 

3,000 

6,000 

10,000 

15,000 

20,000 

0.027 

0.042 

0.055 

0.034 

0.034 

0.081 

V 

2.483 

2.551 

2.417 

2.375 

2.231 

2.133 

[ft  /  sec] 

2.488 

2.484 

2.426 

2.32 

2.188 

2.045 

Pei-. 

0.843 

0.839 

0.846 

0.84 

0.843 

0.827 

6.07 

9.79 

8.62 

21.16 

24.17 

21.69 

^0 

at 

Exn 

1479.6 

1507.7 

1492.2 

1491.8 

1481.5 

1463.1 

[m] 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

Pe,.. 

0.844 

0.837 

0.842 

0.837 

0.8379 

0.836 

0.142 

0.558 

1.065 

0.404 

0.554 

0.668 

To 

59.25 

59.97 

60.56 

63.25 

65.61 

66.11 

[ft] 

60.04 

60.07 

60.35 

60.91 

61.8 

62.75 

Pei-^ 

0.846 

0.842 

0.835 

0.835 

0.824 

0.836 

6.17 

10.0 

10.13 

17.04 

21.44 

20.12 

Ap 

^Exp 

1479.5 

1507.7 

1493.2 

1508.1 

1492.5 

1465.5 

[m] 

1481.6 

1481.6 

1481.6 

1481.7 

1481.7 

1481.7 

Pei-^ 

0.844 

0.838 

0.842 

0.837 

0.837 

0.837 

^  p 

0.62 

0.244 

0.375 

0.033 

1.49 

0.457 

Yp 

^Ey^ 

59.62 

60.76 

63.27 

70.83 

75.96 

78.44 

[ft] 

60.14 

60.23 

61.1 

62.82 

65.43 

68.32 

Pei-^ 

0.842 

0.84 

0.83 

0.817 

0.798 

0.806 

®i?,+ 

0.39 

0.32 

1.06 

1.61 

1.75 

1.44 

R 

17.69 

20.07 

41.25 

63.88 

75.87 

84.33 

[ft] 

16.67 

18.22 

38.68 

57.94 

71.35 

81.04 

Pei-^ 

0.828 

0.817 

0.832 

0.825 

0.826 

0.836 
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The  measurement  Scenario  4  is  investigated  for  different  altitudes  in  Table  4.35. 
Except  the  velocity  estimate,  all  the  other  parameter  estimates  are  better  at  low  altitudes. 
The  velocity  estimate’s  predicted  and  experimental  a  decreases  as  the  altitude  increases. 


Table  4.36  Estimation  performance  as  a  function  of  airspeed  -  Scenario  4. 


Vel  [M] 

0.5 

0.6 

0.7 

0.8 

0.9 

1.0 

^v+ 

0.053 

0.026 

0.071 

0.038 

0.046 

0.006 

V 

2.461 

2.464 

2.521 

2.485 

2.466 

2.46 

[ft  /  sec] 

2.444 

2.461 

2.471 

2.478 

2.482 

2.486 

0.849 

0.839 

0.845 

0.845 

0.847 

0.848 

^x+ 

32.62 

5.09 

15.58 

17.77 

0.149 

26.85 

Ao 

d't 

^Xq 

1498.7 

1467.0 

1475.9 

1479.6 

1453.5 

1492.1 

[m] 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

1481.59 

Pei_„ 

0.839 

0.846 

0.849 

0.845 

0.845 

0.837 

6'^+ 

0.123 

0.436 

1.154 

0.226 

1.594 

0.863 

Em 

60.64 

60.27 

59.41 

60.11 

61.42 

59.71 

[ft] 

60.23 

60.16 

60.12 

60.09 

60.07 

60.06 

0.842 

0.842 

0.841 

0.845 

0.845 

0.842 

^x+ 

33.05 

5.04 

17.28 

17.89 

0.325 

26.06 

Xp 

^Ex^ 

1498.8 

1466.9 

1480.7 

1479.7 

1453.6 

1492.1 

[m] 

1481.6 

1481.6 

1481.6 

1481.7 

1481.7 

1481.7 

Pei-^ 

0.838 

0.846 

0.849 

0.844 

0.844 

0.837 

6'^+ 

^  p 

0.654 

0.505 

0.615 

0.113 

1.528 

0.705 

Yp 

61.66 

61.55 

60.57 

61.08 

61.7 

60.22 

[ft] 

60.72 

60.51 

60.38 

60.29 

60.23 

60.19 

Pei-„ 

0.833 

0.833 

0.839 

0.842 

0.845 

0.844 

^R+ 

1.053 

0.175 

0.929 

0.398 

0.367 

0.014 

R 

36.11 

30.38 

27.29 

24.3 

21.19 

19.09 

[ft] 

34.6 

29.13 

25.05 

21.98 

19.56 

17.61 

Pei-^ 

0.837 

0.83 

0.831 

0.825 

0.828 

0.824 

The  effect  of  aircraft  velocity  changes  are  also  investigated  and  the  statistics  are  doc¬ 
umented  in  Table  4.36.  A  modest  increase  in  estimation  accuracy  is  observed  when  the 
velocity  increases.  As  in  the  previous  scenarios,  the  velocity  estimate  follows  an  opposite 
trend.  In  Table  4.37,  the  effects  of  different  accuracy  levels  of  slant  range  to  P  measure¬ 
ments  and  prior  information  on  the  ground  object’s  altitude  estimate  are  investigated. 
Notable  improvements  occur  when  the  accuracy  of  the  measurements  is  increased.  How- 
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Table  4.37  Estimation  performance  as  a  function  of  different  measurement  errors  -  Sce¬ 
nario  4.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 


[ft] 

[“] 

[ft] 

'^s«[ft] 

cjy-  =  100  ft,  ap-  =  200  ft 

2.371 

1466.3 

59.95 

1466.24 

61.21 

22.93 

(Ty-  =  50  ft,  ap-  =  100  ft 

2.371 

1472.6 

42.75 

1472.6 

41.8 

23.03 

cjy-  =  10  ft,  ap-  =  20  ft 

1.742 

1487.3 

19.23 

1487.4 

9.66 

14.97 

ever,  the  quality  of  own-ship  position  estimate  is  still  dominated  by  the  accuracy  of  the 
unaided  INS  position  estimate. 

Scenario  5.  The  measurement  Scenario  5  is  investigated  for  different 
flight  altitudes  and  for  different  airspeeds  and  the  estimation  performance  statistics  are 
given  in  Tables  4.38  and  4.39,  respectively.  The  own-ship  X-position  estimate  Xq  yields 
an  experimental  a  of  about  30  meters.  Reducing  the  positional  estimation  error  from  0.8 
nm  to  a  positioning  error  a  of  30  meters  is  a  significant  improvement.  The  Yq  estimation 
error  a  is  also  reduced  to  60  feet  from  a  75  feet  error.  In  parallel,  geo-location  performance  is 
within  the  1-a  of  the  ground  object  prior  information  accuracy.  Furthermore,  the  altitude 
estimate  of  the  ground  object  is  now  more  accurate.  Velocity  and  slant  range  estimates  do 
not  significantly  change  in  this  scenario.  As  before,  flight  conditions  of  low  altitude  and 
high  speed  yield  better  estimation  performance. 

The  accuracy  of  the  prior  information  Xp^  and  Yp^  is  now  increased,  and  the  es¬ 
timation  performance  statistics  are  analyzed  in  Table  4.40.  An  estimation  error  standard 
deviation  of  7  meters  for  X,  and  21  feet  for  own-ship  Yo-position  is  very  good  and  could 
be  called  “position  fix-taking”,  since  that  accuracy  may  be  better  than  in  the  current 
fix-taking  modes. 

In  conclusion:  Since  in  this  scenario  we  include  both  prior  X  and  Y  position  informa¬ 
tion  on  the  ground  object,  the  best  performance  so  far  is  obtained.  True,  the  scenario  loses 
its  “tracking  an  unknown  ground  object”  characteristic,  but  still,  it  is  a  passive  INS  aiding 
scheme.  The  inclusion  of  the  ground  object’s  coordinates  information  enhances  estimation 
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Table  4.38  Estimation  performance  as  a  function  of  altitude  -  Scenario  5. 


h  [ft] 

1000 

3,000 

6,000 

10,000 

15,000 

20,000 

V 

[ft  /  sec] 

0.013 

0.012 

0.081 

0.384 

1.444 

2.364 

2.48 

2.449 

2.475 

2.42 

2.42 

2.49 

2.498 

2.493 

2.472 

2.425 

2.341 

2.231 

0.847 

0.849 

0.848 

0.876 

0.939 

0.968 

^0 

[m] 

^x+ 

0.66 

0.169 

0.257 

1.76 

12.3 

29.11 

30.03 

31.14 

32.7 

35.89 

40.11 

47.13 

30.58 

31.07 

32.27 

34.41 

37.24 

40.83 

0.842 

0.841 

0.837 

0.827 

0.728 

0.598 

kb 

[ft] 

-^n 

0.61 

0.647 

0.239 

1.55 

9.163 

21.35 

60.77 

60.75 

60.32 

63.61 

67.21 

70.01 

60.01 

60.09 

60.37 

60.98 

62.0 

63.29 

Pe,.. 

0.839 

0.84 

0.842 

0.838 

0.857 

0.887 

Xp 

[m] 

0.67 

0.075 

0.624 

0.675 

0.544 

0.035 

^Exp 

29.97 

30.44 

30.19 

31.2 

30.16 

30.59 

30.472 

30.472 

30.472 

30.472 

30.472 

30.472 

Pei-^ 

0.841 

0.847 

0.847 

0.843 

0.848 

0.842 

Yp 

[ft] 

c-^+ 

0.555 

0.043 

0.717 

3.77 

18.79 

37.91 

60.82 

61.93 

63.88 

70.55 

79.9 

90.04 

60.04 

60.3 

61.16 

63.04 

66.13 

69.87 

Pei-^ 

0.838 

0.836 

0.833 

0.795 

0.715 

0.641 

R 

[ft] 

®R+ 

0.01 

0.515 

1.256 

9.52 

50.47 

112.17 

^En 

9.59 

23.66 

42.34 

65.93 

89.48 

116.05 

9.18 

22.13 

39.47 

60.57 

82.63 

105.28 

Pei-^ 

0.829 

0.827 

0.828 

0.853 

0.927 

0.969 

performance  and  thus  INS  aiding  action.  We  could  consider  this  scenario  a  robust  way  of 
aiding  the  INS  by  optically  tracking  a  “known”  ground  object. 
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Table  4.39  Estimation  performance  as  a  function  of  airspeed  -  Scenario  5. 


Vel  [M] 

0.5 

0.6 

0.7 

0.8 

0.9 

1.0 

^v+ 

0.035 

0.01 

0.017 

0.037 

0.004 

0.01 

V 

^Ev 

2.5 

2.487 

2.516 

2.518 

2.502 

2.504 

[ft  /  sec] 

2.482 

2.488 

2.491 

2.493 

2.494 

2.495 

Pei-„ 

0.843 

0.838 

0.839 

0.838 

0.841 

0.84 

^x+ 

0.178 

0.198 

0.101 

0.505 

0.186 

0.257 

^0 

32.01 

31.59 

31.05 

31.1 

31.00 

30.72 

[m] 

31.98 

31.53 

31.26 

31.08 

30.95 

30.86 

Pe,.. 

0.84 

0.842 

0.839 

0.844 

0.839 

0.838 

6-^+ 

0.406 

0.236 

0.142 

1.817 

0.455 

0.144 

To 

at 

Evn 

60.63 

60.14 

61.34 

61.03 

59.77 

60.35 

[ft] 

60.24 

60.16 

60.12 

60.09 

60.07 

60.06 

Pei-„ 

0.838 

0.843 

0.834 

0.842 

0.832 

0.84 

^x+ 

0.32 

0.266 

0.016 

0.672 

0.257 

0.234 

Xp 

^Ex^ 

30.42 

30.52 

30.14 

30.32 

30.43 

30.33 

[m] 

30.472 

30.472 

30.472 

30.472 

30.472 

30.472 

Pei-„ 

0.838 

0.841 

0.841 

0.852 

0.844 

0.839 

6-^+ 

^  p 

0.523 

0.448 

0.179 

1.749 

0.679 

0.199 

Yp 

^Ey^ 

62.07 

61.11 

62.84 

61.73 

59.97 

61.02 

[ft] 

Tv 

60.76 

60.52 

60.39 

60.3 

60.23 

60.19 

Pei-„ 

0.841 

0.837 

0.831 

0.845 

0.839 

0.838 

^R+ 

0.456 

0.279 

0.251 

0.507 

0.292 

0.198 

R 

36.96 

30.48 

27.3 

24.54 

21.56 

19.45 

[ft] 

35.26 

29.4 

25.2 

22.11 

19.69 

17.67 

Pei-„ 

0.832 

0.84 

0.823 

0.82 

0.822 

0.823 

Table  4.40  Estimation  performance  as  a  function  of  different  measurement  errors  -  Sce¬ 
nario  5.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 


[ft /sec] 

[“] 

[ft] 

[“] 

[ft] 

ftp«[ft] 

(Tv-  =  (Ty-  =  100  ft 

Yp  Ap 

2.453 

31.1 

59.87 

30.37 

60.74 

23.77 

(Tv-  =  (Tv-  =  50  ft 

Yp  Pip 

2.475 

16.64 

42.99 

15.22 

41.27 

23.92 

(Tv-  =  (Tv-  —  10  ft 

Yp  Xp 

2.423 

7.25 

21.47 

3.06 

9.7 

23.34 
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Scenario  6.  In  this  final  measurement  scenario,  complete  prior 

information  and  the  slant  range  measurement  are  included  in  the  estimation  algorithm. 
Tables  4.41,  4.42,  and  4.43  show  the  estimation  performance  statistics  for  this  “measure¬ 
ment  rich”  scenario. 

The  estimation  performance  as  a  function  of  altitude  is  given  in  Table  4.41.  The 
experimental  a  and  the  predicted  a  values  of  the  Xq  estimation  error  are  close  and  are 
about  30  meters.  The  reduction  from  0.8  nm  (1481.6  meters)  of  the  estimation  error  a 
to  30  meters  is  a  desirable  result.  An  increase  in  altitude  causes  a  slight  decrease  in  Xq 
estimation  accuracy.  Own-ship  altitude  estimation  error  is  also  reduced;  however,  the 
reduction  of  error  to  60  feet  from  75  feet  is  not  that  significant;  it  responds  to  altitude 
changes  similar  to  the  Xq  estimate.  We  recall  that  the  uncertainty  in  the  coordinates  of  the 
ground  object  {axp  and  ayp)  is  100  feet.  The  experimental  variance  of  the  Xp  estimation 
error  is  maintained  within  this  bound  while  ayp  is  reduced  to  60  feet.  For  both  Xp  and 
Yp,  lower  altitudes  yield  better  performance.  The  velocity  estimation  error  variance  is 
reduced,  as  flight  altitude  increases.  The  slant  range  estimate  shows  a  slight  improvement 
in  comparison  to  the  previous  scenarios,  since  additional  information  is  used. 

The  estimation  performance  versus  airspeed  statistics  are  given  in  Table  4.42.  In¬ 
creasing  airspeed  makes  the  estimates  more  accurate.  However,  the  accuracy  enhancements 
resulting  from  higher  velocities  are  not  significant.  The  predicted  Xp  estimation  error  vari¬ 
ance  does  not  change  with  airspeed  whereas  the  ground  object’s  A-coordinate  estimation 
error  a  is  about  100  feet  (~  30  m)  for  all  airspeeds. 

To  increase  the  estimation  accuracy,  we  also  performed  experiments  using  high,  and 
very  high  accuracy  measurements.  The  statistics  are  given  Table  4.43.  Clearly,  if  we  have 
accurate  measurements,  the  estimates  produced  by  the  algorithm  are  very  good. 
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Table  4.41  Estimation  performance  as  a  function  of  altitude  -  Scenario  6. 


h  [ft] 

1000 

3,000 

6,000 

10,000 

15,000 

20,000 

®t/+ 

0.028 

0.013 

0.068 

0.018 

0.008 

0.037 

V 

2.504 

2.475 

2.434 

2.31 

2.212 

2.133 

[ft  /  sec] 

2.496 

2.478 

2.425 

2.321 

2.188 

2.044 

-Pei_, 

0.841 

0.844 

0.85 

0.842 

0.839 

0.842 

€■  ^+ 

0.21 

0.252 

0.3 

0.549 

0.437 

0.024 

^0 

30.57 

31.2 

32.38 

34.96 

37.59 

40.36 

[m] 

30.59 

31.06 

32.19 

34.09 

35.33 

36.02 

PEl-a 

0.842 

0.837 

0.837 

0.828 

0.83 

0.814 

G-y-^r 

0.239 

0.037 

0.913 

2.22 

0.109 

0.136 

To 

60.54 

59.89 

61.42 

62.55 

63.97 

65.49 

[ft] 

60.01 

60.09 

60.36 

60.9 

61.76 

62.74 

-Pei_, 

0.835 

0.843 

0.841 

0.839 

0.837 

0.831 

^x+ 

0.214 

0.23 

0.107 

0.171 

0.435 

0.31 

Xp 

30.44 

30.46 

30.37 

30.73 

30.88 

30.32 

[m] 

30.472 

30.472 

30.472 

30.472 

30.472 

30.472 

Pei-^ 

0.841 

0.839 

0.838 

0.836 

0.838 

0.847 

Gy  + 

^  P 

0.165 

0.261 

0.047 

1.608 

1.487 

1.432 

Yp 

^Ey^ 

60.82 

60.75 

64.53 

69.92 

74.54 

77.9 

[ft] 

60.04 

60.3 

61.12 

62.8 

65.41 

68.3 

Pei-^ 

0.835 

0.837 

0.823 

0.814 

0.808 

0.797 

®i?+ 

0.045 

0.049 

1.557 

1.323 

0.707 

1.76 

R 

10.23 

23.89 

41.65 

61.313 

74.57 

84.88 

[ft] 

9.56 

21.91 

38.67 

57.95 

71.44 

81.11 

PEl-a 

0.829 

0.822 

0.833 

0.836 

0.837 

0.834 
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Table  4.42  Estimation  performance  as  a  function  of  airspeed  -  Scenario  6. 


Vel  [M] 

0.5 

0.6 

0.7 

0.8 

0.9 

1.0 

®y+ 

0.053 

0.01 

0.032 

0.01 

0.026 

0.005 

V 

2.449 

2.412 

2.39 

2.467 

2.494 

2.492 

[ft  /  sec] 

2.444 

2.461 

2.471 

2.477 

2.482 

2.485 

Pei-„ 

0.848 

0.85 

0.85 

0.841 

0.837 

0.833 

0.191 

0.005 

0.614 

0.188 

0.319 

0.374 

^0 

32.0 

30.81 

31.54 

31.07 

31.1 

30.94 

[m] 

31.93 

31.51 

31.24 

31.07 

30.94 

30.86 

Pe,.. 

0.839 

0.844 

0.834 

0.84 

0.832 

0.843 

0.87 

0.68 

0.321 

0.271 

1.971 

2.212 

To 

at 

Evn 

61.26 

59.73 

59.93 

60.03 

61.13 

59.39 

[ft] 

60.23 

60.16 

60.12 

60.09 

60.07 

60.06 

Pei-, 

0.828 

0.839 

0.84 

0.84 

0.839 

0.838 

^x+ 

0.513 

0.012 

0.471 

0.222 

0.38 

0.002 

Xp 

^Exp 

30.43 

29.8 

30.74 

30.41 

30.52 

30.39 

[m] 

30.47 

30.47 

30.47 

30.47 

30.47 

30.47 

Pei-, 

0.839 

0.843 

0.834 

0.839 

0.834 

0.844 

^  p 

1.241 

0.918 

0.247 

0.069 

1.488 

2.146 

Tp 

^Ey^ 

62.97 

60.58 

60.99 

61.09 

61.85 

60.04 

[ft] 

60.72 

60.52 

60.38 

60.29 

60.23 

60.19 

Pei-, 

0.825 

0.833 

0.83 

0.836 

0.841 

0.833 

^R+ 

1.1 

0.035 

0.437 

0.206 

0.09 

0.147 

R 

36.29 

29.61 

25.72 

23.7 

21.28 

19.44 

[ft] 

34.6 

29.13 

24.99 

22.0 

19.57 

17.63 

Pei-, 

0.837 

0.844 

0.837 

0.824 

0.82 

0.812 

Table  4.43  Estimation  performance  as  a  function  of  different  measurement  errors  -  Sce¬ 
nario  6.  The  altitude  and  velocity  are  3,000  feet  and  0.8  M,  respectively. 


[ft] 

^£v.[ft/sec] 

^Ex,  [“] 

^Ey,  [ft] 

[“] 

[ft] 

fts«[ft] 

ay-,  ax-  =  100,  cjp-  =  200 

2.427 

30.77 

59.52 

30.07 

60.34 

23.35 

ay--,  ax-  =  50,  Up-  =  100 

2.406 

16.59 

42.57 

15.36 

41.59 

23.07 

fTp-=20 

1.71 

5.44 

19.12 

3.07 

9.81 

14.94 
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4-3. 2. 4  Comparison  of  the  Measurement  Scenarios.  Phase  1  en¬ 
tailed  the  estimation  of  the  angular  navigation  variables  and  in  Phase  2  the  positional 
navigation  variables  are  etimated.  The  estimation  performance  statistics  of  the  algorithm 
which  is  applied  to  six  different  measurement  scenarios  is  based  on  5000  “independent”  MC 
runs.  In  each  scenario,  the  random  number  generator  is  used  to  simulate  white  Gaussian 
noise  for  each  measurement.  The  results  documented  in  Tables  4.27  to  4.43  were  obtained 
with  different  samples  of  noise  applied  to  the  variables  in  each  run  across  the  measure¬ 
ment  scenarios.  Based  on  these  independent  experiments,  we  now  analyze  the  estimation 
statistics  for  each  estimation  parameter. 

Fig  4.11  shows  the  comparison  of  the  experimental  error  variance  of  own-ship  X- 
position  estimate  for  the  6  measurement  scenarios.  Measurement  Scenarios  5  and  6  are 
clearly  preferable  to  Scenarios  1,  2,  3,  and  4.  The  estimation  results  in  Scenarios  5  and  6 
reflect  the  Xp  prior  information  accuracy.  In  Scenarios  1,  2,  3,  and  4,  the  error  standard 
deviation  of  the  estimates  is  about  0.8  NM,  since  they  are  driven  by  the  INS  provided  Xq 
measurements. 


Xq  Estimate  Error  Standard  Deviation 


Figure  4.11  Own-ship  X-Position  Estimate:  Comparison  of  Scenarios 

The  comparison  of  geo-location  performance  concerning  the  Xp  coordinate  is  given 
in  Fig  4.12.  The  results  are  similar  to  the  Xq  estimation  performance  results.  Inclusion 
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of  prior  information  on  Xp  in  Scenarios  5  and  6  yields  an  estimation  error  a  of  about  30 
meters. 


Xp  -  Geo-location  Error  Standard  Deviation 


Figure  4.12  Xp  -  Geo-location:  Comparison  of  Scenarios 

Estimation  error  variance  comparisons  for  own-ship  altitude  estimation  are  shown 
in  Fig  4.13.  Scenarios  1  and  3  in  this  experiment  do  not  include  Yp  prior  information. 
The  1-cj  value  of  the  INS  provided  altitude  measurement  is  75  feet;  and  after  aiding,  the 
recorded  estimation  errors  are  about  75  feet  for  Scenarios  1  and  3.  Scenarios  2,  4,  5,  and  6 
include  Yp  prior  information.  At  low  altitudes,  the  estimation  error  is  reduced  to  60  feet 
with  the  inclusion  of  100  feet  accurate  Yp  prior  information.  The  estimation  performance 
accuracy  decreases  with  altitude.  However,  if  the  slant  range  measurement  is  also  included, 
the  deterioration  of  accuracy  with  altitude  is  less,  pronounced  as  is  the  case  in  Scenarios 
4  and  6. 

The  ground  object  altitude  estimation  errors  are  compared  in  Fig  4.14.  In  Scenario  1 
and  3,  the  estimation  error  variance  shows  a  considerable  increase  when  the  flight  altitude 
increases.  Scenarios  1  and  3  do  not  include  Yf  prior  information.  In  the  remaining 
scenarios,  an  improvement  similar  to  the  improvement  in  own-ship  altitude  estimation  is 
observed;  the  results  are  very  similar  in  both  cases. 
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The  velocity  estimation  performance  comparison  is  shown  in  Fig  4.15.  The  results 
are  better  than  the  unaided  velocity  error  variance  of  2.5  ft/sec.  In  Scenarios  3,  4,  and  6, 
the  inclusion  of  slant  range  measurement  decreases  the  error  variance. 


Velocity  Estimation  Error  Standard  Deviation 


Figure  4.15  Velocity  Estimate:  Comparison  of  Scenarios 

4-3.3  Additional  Comparison  of  the  Scenarios  and  the  Measure¬ 
ment  Situations.  We  investigated  INS  aiding  by  optically  tracking  an  unknown 
ground  object.  Two  different  algorithms  were  developed.  Common  to  both,  Phase  1  in¬ 
cludes  the  estimation  of  the  angular  navigation  variables.  The  estimation  performance 
statistics  of  the  two  algorithms  which  are  applied  to  six  different  measurement  situations 
are  based  on  5000  “independent”  MC  runs.  Thus,  in  each  scenario,  the  random  number 
generator  is  used  to  simulate  white  Gaussian  noise  for  each  variable  and  measurement.  As 
a  result,  different  samples  of  noise  are  applied  to  each  parameter  in  each  run.  We  analyzed 
the  particular  scenario  statistics  based  on  these  independent  experiments. 

In  this  stage  of  our  work,  we  repeat  the  MC  experiments  and  we  compare  the  es¬ 
timates’  statistics  for  the  various  scenarios  when  the  same  measurement  noise  realization 
is  used  in  all  scenarios.  This  comparison  is  performed  in  three  cases  and  the  results  are 
shown  in  Figures  4.16  to  4.31. 
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4.3.3. 1  Case  1. 


In  Case  1,  we  assume  that  the  INS  provides  measure¬ 


ments  with  the  statistics 


o'Xo  =  0.8  nm,  oyq  =  75  feet,  ay  =  2.5  ftjsec 

The  prior  information  on  the  ground  object’s  position,  and  the  slant  range  measurement 
statistics  are  specified  by 

axp  =  100  ft,  avp  =  100  ft,  an  =  200  ft 

A  fixed  set  of  random  measurements  is  used  in  all  scenarios. 

In  Figure  4.16,  the  own-ship  X-position  estimation  error  is  analyzed.  In  Sens  5, 
6  and  in  Sits  5,  and  6,  a  very  good  estimate  is  obtained.  The  remaining  parameters’ 
errors  are  relatively  high.  The  reason  for  this  significant  accuracy  difference  comes  from 
having  the  prior  information  on  the  “unknown”  ground  object.  The  inclusion  of  slant 
range  measurement  usually  improves  the  estimation  accuracy.  Moreover,  in  Sen  5  and 
6,  the  results  are  better  than  the  results  in  Sits  5  and  6,  even  in  the  case  where  the 
same  measurements  realizations  is  used.  The  estimation  errors  in  the  other  Scenarios  and 
measurement  Situations  are  close,  and  in  the  big  picture,  it  is  not  very  significant  to  observe 
which  one  performs  better  since  the  estimation  accuracy  in  Sens  5  and  6  is  satisfactory. 

In  Fig  4.17,  we  investigate  the  Xp  estimation  errors.  The  results  are  almost  the 
same  as  in  the  Xq  comparison.  In  the  Scenarios  and  measurement  Situations  having  Yp 
and  Xp  information  (Sit  3,  6  and  Sen  5,  6)  the  smaller  estimation  error  is  recorded.  Sens 

1,  2,  3,  4,  and  Sits  2  and  4  including  Yf  and/or  Rm  information,  result  in  a  larger  error; 
nevertheless,  in  measurement  Sits  2  and  4  the  errors  are  larger  than  the  errors  in  Sens  1, 

2,  3,  and  4.  The  accuracy  of  the  estimates  in  Sens  5  and  6  and  in  the  measurement  Sits 
5  and  6  are  almost  equal;  therefore,  we  conclude  that  the  inclusion  of  the  ground  object 
coordinates  information  significantly  enhances  the  estimation  performance. 
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Comparisons  of  own-ship  altitude  estimation  performance  are  shown  in  Fig  4.18.  All 
scenarios  in  which  Yf  information  is  included  (Sens  2,  4,  5,  and  6),  except  Sen  3,  yield 
own-ship  altitude  information  more  accurately  than  in  Sen  3,  and  Sits  2,  4,  5,  and  6. 


Comparison  of  Estimation  Errors  in 


Figure  4.18  Own-ship  y-Position  Estimate  -  Case  1:  Comparison  of  Scenarios 

The  ground  object  altitude  estimation  errors  are  compared  in  Fig  4.19.  The  results 
in  the  figure  are  similar  to  the  Yq  results.  In  all  Scenarios,  performance  is  better  than 
Situations.  In  Sens  1  and  3  the  errors  are  relatively  larger  than  in  the  other  Scenarios, 
because  of  a  lack  of  Yf  information.  In  Sens  2,  4,  5,  and  6  the  estimation  error  is  similar. 


The  velocity  estimation  performance  comparison  in  Fig  4.20  shows  that  the  most 
accurate  estimates  are  obtained  in  Sens  4  and  6.  The  worst  estimates  are  produced  in 
Sens  1,  and  2,  and  in  measurement  Sit  5.  We  conclude  that  inclusion  of  the  slant  range 
measurement  Rm  and  ground  object  altitude  information  Yf  is  the  reason  for  having 
better  accuracy  than  in  the  others  cases.  The  slant  range  measurement  is  not  included  in 
the  worst  three. 
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4 -3. 3. 2  Case  2.  In  this  case,  we  assume  that  the  aircraft  has  flown  an 
hour,  and  the  INS  provides  own-ship  position  estimates  as  following 

^OiNs  =  +  0-8  nm,  lo/ivs  =  ^Otrue  +  75  feet,  Vms  =  Vtrue  +  2.5  ft/sec 

Randomly  chosen  prior  information  on  the  ground  object,  and  the  slant  range  measurement 
statistics  are  as  in  Case  1. 

Fig  4.21  shows  the  comparison  of  the  measurement  scenarios  for  Xq.  The  results 
are  very  obvious.  The  estimation  performance  in  the  scenarios  with  prior  information  on 
the  ground  object  is  superior  to  the  performance  in  the  scenarios  where  this  additional 
information  is  not  available.  Indeed,  in  scenarios  where  Xp  information  is  included  (Sens 
5,  6,  measurement  Sits  5  and  6  the  estimation  accuracy  is  highly  correlated  with  Xp 
accuracy.  The  Xq  accuracy  in  the  other  scenarios  is  about  the  same  as  the  INS  provided 
Xq  estimate,  since  the  improvement  is  not  significant.  Fig  4.22  also  shows  the  zoomed-in 
version  of  the  estimation  errors  for  Sens  5  and  6  and  measurement  Sits  5  and  6.  In  Sens  5 
and  6  the  estimation  performance  is  slightly  better  than  in  Sits  5  and  6. 


Comparison  of  Estimation  errors  in 


Figure  4.21  Own-ship  X-Position  Estimate  -  Case  2:  Comparison  of  Scenarios 

Geo-location  on  the  X  axis  performance  for  different  measurement  scenarios  is  shown 
in  Fig  4.23.  The  results  are  almost  the  same  as  for  estimation. 
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Own-ship  altitude  estimates  are  compared  in  Fig  4.24.  We  observe  that  inclusion 
of  Yp  information  affects  only  estimates  in  various  Scenarios;  that  is,  the  accuracy  of  the 
altitude  estimates  produced  in  the  measurement  Situations  is  driven  by  the  INS  provided 
altitude  measurements  and  does  not  change  with  the  inclusion  of  Yp  information.  Fur¬ 
thermore,  the  accuracy  of  the  estimates  in  various  measurement  Situations  including  Yf 
information,  is  almost  identical  to  the  accuracy  in  the  Scenarios  that  do  not  include  Yf 
information. 


Comparison  of  Estimation  Errors  in 


Figure  4.24  Own-ship  Y-Position  Estimate  -  Case  2:  Comparison  of  Scenarios 

Fig  4.25  shows  the  Y  geo-location  error  comparison.  Contrary  to  expectations,  we 
observe  that  the  results  in  the  various  measurement  Situations  outperform  the  Scenarios’ 
results.  The  error  magnitudes  in  measurement  Sits  2,  4,  5,  and  6  are  very  close,  however, 
in  measurement  Sit  5  the  error  is  slightly  less. 

In  Fig  4.26,  the  velocity  estimate  comparison  is  given.  The  estimation  errors  do  not 
display  a  clear  pattern.  Probably,  the  inclusion  of  the  slant  range  measurement  makes 
some  difference.  Indeed,  this  is  one  of  the  rare  occasions  where  the  estimation  results  in 
the  measurement  Situations  outperform  the  Scenarios’  result. 
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4 -3. 3. 3  Case  3.  In  the  Case  3,  we  use  complete  prior  information  on  the 


location  of  P  and  we  use  a  slant  range  measurement. 

^OINS  =  +  0-8  nm,  lo/ivs  =  +  75  feet,  Vms  =  Vtrue  +  2.5  ft/sec 

Xp  =  +  100/t,  Yp  =  Yp^^^^  +  100/f,  R  =  Rtrue  +  200/f 


First,  in  Fig  4.27  we  compare  the  estimation  results  for  own-ship  position  X^.  The 
estimation  error  comparisons  are  similar  to  the  the  results  in  Cases  1  and  2.  In  Sens  5, 
and  6,  and  in  measurement  Sits  5  and  6,  a  very  accurate  estimates  are  obtained,  but  this 
time,  there  is  a  notable  difference  between  Sens  5  and  6  and  measurement  Sits  5  and  6: 
The  best  results  are  obtained  in  Sen  6. 


Comparison  of  Estimation  Errors  in 


Figure  4.27  Own-ship  Y-Position  Estimate  -  Case  3:  Comparison  of  Scenarios 

The  comparison  of  geo-location  performance  for  Xp  is  given  in  Fig  4.28.  The  results 
reflect  the  Xq  estimation  results. 

Inclusion  of  Yp  information  significantly  affects  own-ship  altitude  estimation  perfor¬ 
mance.  This  is  shown  in  Fig  4.29.  The  Scenarios  including  Yf  information  yield  better 
altitude  accuracy  and  in  the  rest  of  the  Scenarios  and  measurement  Situations  almost  the 
same  accuracy  is  obtained.  We  note  that  the  inclusion  of  Yp  information  does  not  affect 
the  estimation  accuracy  in  the  various  measurement  Situations. 
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Fig  4.30  shows  the  ground  object  altitude  estimation  performance  for  the  various 
scenarios.  As  in  Case  2,  in  the  various  measurement  Situations  the  estimation  performance 
is  better  than  in  the  respective  Scenarios.  Two  Scenarios  (Sens  1  and  Sen  3)  do  not  include 
Yp  prior  information,  so  they  yield  the  poorest  accuracies. 


Comparison  of  Estimation  Errors  in  Yp 


Figure  4.30  Yp  -  Geo-location  -  Case  3:  Comparison  of  Scenarios 


Comparison  of  Estimation  Errors  in  Vel 


Figure  4.31  Velocity  Estimation  -  Case  3:  Comparison  of  Scenarios 

The  velocity  estimation  comparison  is  given  in  Fig  4.31.  The  slant  range  measure¬ 
ment  contributes  to  accuracy  enhancement.  Thus,  in  measurement  Sits  4  and  6  the  mini- 
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mum  estimation  error,  is  recorded.  In  the  scenarios  equivalent  to  these  two  measurement 
Situations  (Sens  4  and  6),  the  largest  errors  are  recorded  even  though  they  include  the  same 
measurements  realizations  as  in  measurement  Sits  5  and  6.  The  estimation  performance 
in  the  remaining  measurement  situations  is  slightly  better  than  in  the  Scenarios. 


Summary 

In  this  section,  we  performed  the  analysis  of  the  estimation  performance  based  on 
the  simulations.  Initially,  we  investigated  optimal  measurement  geometry  to  set  up  mea¬ 
surement  scenarios  used  in  simulations.  We  classified  the  simulations  into  two  phases.  In 
Phase  1,  the  estimation  of  A/C  angular  navigation  variables  were  performed.  The  statis¬ 
tics  of  the  estimation  performance  were  given  in  Tables.  In  Phase  2,  we  used  two  different 
algorithm  to  perform  the  A/C  positional  navigation  variables:  standard  linear  regression 
and  singular  linear  regression.  Each  algorithm  were  validated  by  simulations  including  six 
different  measurement  situations.  The  estimation  performance  statistics  result  from  the 
simulation  of  each  measurement  situation  were  again  documented  in  Tables.  We  thor¬ 
oughly  discussed  the  results  of  the  statistics.  Finally,  we  performed  the  comparison  of  two 
aforementioned  algorithm  based  on  the  measurement  scenarios  simulated. 
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V,  Conclusions  and  Recommendations 

5. 1  Conclusions 

INS-aiding  by  optically  tracking  a  stationary  ground  object  over  time  is  investigated. 
It  is  assumed  that  the  position  of  the  ground  object  is  not  known  and  that  passive,  bearings- 
only,  measurements  are  taken  over  time  using  an  electro-optical  tracker.  The  measurement 
situation  is  modelled  and  an  estimation  algorithm  is  developed. 

A  careful  analysis  of  the  proposed  parsimonious  optical  measurement  scheme  reveals 
the  following.  The  LOS  measurements  are  conducive  to  a  stand-alone  estimate  of  the 
angles  a'  and  (3'  included  between  the  aircraft’s  inertial  velocity  vector  V  and  the  aircraft 
body  axes.  Hence,  assuming  the  absence  of  wind;  that  is,  when  the  air  mass  is  stationary 
and  the  ground  speed  =  air  speed,  we  obtain  a  stand-alone  estimate  of  the  aircraft’s  Angle 
of  Attack  OL  and  side  slip  angle  /3.  More  importantly,  the  measured  o3  and  (3'  angles  are 
related  to  the  aircraft  angular  navigation  variables,  i.e.,  the  aircraft’s  attitude,  heading, 
and  flight  path  angle.  Thus,  the  a'  and  [3'  angle  measurements  provided  by  the  optical 
sensor  can  be  used  for  INS  aiding.  Indeed,  the  proposed  INS  aiding  concept  is  a  modern 
mechanization  of  a  driftmeter  [9]. 

The  INS-aiding  process  entails  two  phases.  We  exclusively  address  the  angular  nav¬ 
igational  variables  in  Phase  1  and  update  the  INS-provided  estimates  of  aircraft’s  pitch 
angle  6  and  aircraft’s  fight  path  angle  7  using  the  optically  provided  a'  measurement.  It  is 
shown  that  the  aircraft’s  attitude  and  flight  path  angles’  estimates  can  be  improved,  thus 
achieving  a  degree  of  INS  aiding.  In  a  full  three  dimensional  setting,  the  a'  and  f3'  optical 
measurements  afford  improved  roll,  pitch,  yaw  angles,  ij:,  6,  4>,  and  flight  path  angle  7  and 
heading  H  estimates.  The  attendant  algorithm  which  uses  bearings-only  measurements  is 
referred  to  as  Phase  1  of  the  INS  aiding  process.  Improving  the  aircraft’s  attitude  estimate 
is  important  in  modern  sensor-rich  platforms.  However,  the  optical  flow  measurement, 
while  helping  to  improve  the  angular  navigational  variables’  estimates,  has  little  impact  on 
the  estimation  of  the  aircraft’s  positional  navigation  variables.  Since  the  improved  angu¬ 
lar  navigation  variables  will  be  used  in  the  determination  of  orientation  of  accelerometers 
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(direction  cosine  matrix),  we  claim  that  any  improvement  in  angular  variables  causes  an 
improvement  in  positional  accuracy. 

The  results  of  Phase  1  are  used  in  Phase  2  to  improve  the  INS-provided  position 
estimates.  Phase  2  includes  two  different  estimation  algorithms.  None  of  the  algorithms 
satisfies  the  objectives  determined  in  the  very  beginning  when  the  bearings-only  measure¬ 
ments  on  an  unknown  ground  object  are  used  as  a  stand-alone  aiding  measurement.  In 
order  to  improve  the  estimates  of  the  positional  navigation  variables,  information  on  the 
position  of  the  ground  object  is  required.  The  inclusion  of  information  on  altitude  only, 
or  the  altitude  and  position  coordinate  of  point  P  with  or  without  the  slant  range  mea¬ 
surement  to  the  ground  object,  are  investigated.  Hence,  the  inclusion  of  information  on 
the  ground  object’s  position  in  the  linear  regression  is  undertaken.  Finally,  the  slant  range 
measurement  to  the  tracked  point  P  is  also  augmented  into  the  linear  regression.  In  the 
scenarios  we  assume  the  ground  object  is  unknown,  the  estimation  performance  is  poor. 
The  most  accurate  own-ship  position  estimate  and  the  most  accurate  geo-location  results 
are  jointly  obtained,  using  prior  ground  object  position  and  altitude  information,  and  the 
slant  range  measurement.  Comparison  of  the  algorithms  shows  that  the  second  estimation 
algorithm  (singular  linear  regression)  yields  better  estimation  performance,  in  general. 


5.2  Recommendations 

To  extend  this  study,  the  following  recommendations  are  provided. 

1.  In  Phase  1,  the  Minimum  Error  Variable  (MV)  estimation  formulae  are  used  to 
estimate  the  angular  navigation  variables.  The  equation  error  covariance  R  used  is 
a  diagonal  matrix.  This  is  tantamount  to  assuming  that  the  INS-provided  9  and  7 
estimates  are  uncorrelated.  The  proper  off-diagonal  elements  of  the  equation  error 
matrix,  if  available,  should  be  included.  By  so  doing,  the  estimation  accuracy  will 
increase. 

2.  For  each  specified  scenario,  in  Phase  1,  we  perform  a  MC  experiment  to  obtain 
the  statistics  of  the  errors  in  x  and  y.  The  latter  would  be  required  in  the  sequel. 
Thus,  assuming  V  is  known,  we  estimated  Xi  and  iji]  since  the  true  x  and  y  in 
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the  simulation  are  known,  we  experimentally  obtain  the  2x2  covariance  matrix 
Px^y  which  renders  the  statistics  of  the  x  and  y  estimation  errors.  A  more  accurate 
covariance  matrix  estimate  might  be  possible  since  the  1000  MC  runs  using  MatLab’s 
random  number  generator  may  not  reflect  an  adequate  statistics.  Thus,  while  a  highly 
optimistic  statistic  is  obtained  in  one  scenario,  the  next  set  of  random  numbers  may 
produce  lopsided  results.  The  latter,  especially  in  an  estimation  process  in  which  very 
small  numbers  are  handled,  may  yield  misleading  results.  Moreover,  the  comparison 
between  two  scenarios  may  not  be  fair.  Increasing  the  number  of  MC  runs  is  the 
best  solution,  but  it  will  increase  the  calculation  time  and  memory  requirements. 

3.  The  optimal  measurement  geometry  is  developed  in  Section  4.1.  In  that  section, 
we  mention  a  constraint  on  the  measurement  geometry:  the  limitation  for  the  LOS 
depression  angle  in  front  of  a  fighter  aircraft.  This  constraint  implies  that  track  ini¬ 
tialization  is  not  chosen  at  will;  the  last  point  to  initiate  the  track  is  determined  by 
the  Eq.  (4.3).  The  Xp  and  Yp  used  in  this  calculation  is  theoretically  assumed  un¬ 
known.  We  use  these  two  synthetical  variables  to  determine  Xq]  however,  it  shouldn’t 
be  conceived  of  as  an  aircraft  position  estimate  at  the  beginning  of  ground  object 
tracking.  It  “simulates”  the  point  where  the  pilot  manually  initiates  the  track. 

4.  At  the  end  of  the  Section  4.1,  the  measurement  scenario  using  delayed  tracking  to 
get  close  enough  to  guarantee  overflying  the  ground  object  is  declared  the  optimal 
scenario.  To  realize  this  delayed  tracking,  we  use  Xp  and  Yp  information  which 
is  assumed  unknown.  This  is  not  possible  in  real  life.  Simply  put,  the  pilot  must 
estimate  his  distance  from  the  ground  object,  his  altitude  and  his  airspeed. 

5.  Aforementioned  conclusions  state  that  the  tracking  an  unknown  ground  object  by 
using  optical  measurement  aids  the  INS  angular  navigation  variable  estimates  but 
has  little  impact  on  the  estimation  of  the  aircraft’s  positional  navigation  variables. 
The  basic  reason  for  this  is  the  weakness  of  observability  of  the  aircraft’s  state  which 
is  provided  by  the  the  aircraft’s  aerodynamic  angles.  An  automated  passive  ground 
object  tracker,  independent  from  the  pilot,  may  take  bearing  measurements  and  may 
be  applied  to  the  proposed  aiding  algorithm.  Continuously  performing  the  estimation 
process  may  improve  the  situation  little  by  little. 
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INS  aiding  algorithms  suggested  in  this  research  aim  to  improve  A/C  navigation  vari¬ 
ables.  After  taking  several  LOS  measurements,  estimation  calculation  is  performed 
for  the  initial  point  of  the  aircraft.  In  the  simulation  results,  we  analyze  the  statistics 
of  the  variables’  estimation  supported  by  the  optical  measurements.  Actually,  what 
can  be  done  is  that  another  simulation  to  aid  the  INS  current  measurements  using 
these  estimates.  Furthermore,  a  successive  aiding  simulations  may  yield  significant 
reduction  of  INS  positioning  error. 

6.  In  the  estimation  algorithm,  two  look-up  tables  are  used.  The  first  look-up  table  is 
for  providing  the  optimum  values  of  the  sampling  interval  for  an  acceptable  geometry 
and  statistics.  The  second  is  utilized  for  the  statistics  of  the  optical  measurement 
of  the  angle  between  aircraft’s  flight  path  and  initial  LOS  vector,  7/5.  The  error 
variance  of  this  measurement  changes  for  each  flight  condition;  thus,  a  table  is  created 
including  experimental  error  variances  for  the  7^)  measurements.  These  two  tables  are 
constructed  by  running  MC  runs  and  by  analyzing  the  results.  The  MC  experiments 
for  sampling  interval  are  usually  performed  at  lower  altitudes;  experiments  at  higher 
altitudes  are  rare.  The  look-up  table  for  is  10  by  48.  Look-up  tables  can  always 
be  enlarged.  This  has  the  potential  for  improved  estimation  performance. 

7.  At  higher  altitudes,  the  significant  deterioration  of  estimation  performance  and  the 
requirement  for  increased  tracking  times  are  the  the  most  notable  disadvantages  of 
the  INS  aiding  method.  These  handicaps  deserve  to  be  further  studied. 

8.  The  parameter  estimation  algorithm  using  singular  regression  in  Section  4.3.2  presents 
some  singularity  problems  for  various  flight  conditions.  Flight  conditions  involving 
steep  dive  angles  at  altitudes  above  15,000  feet  cause  estimation  results  which  may 
not  be  accurate  because  of  bad  scaling.  The  diagonal  matrix  D  with  positive  ele¬ 
ments  is  the  output  of  the  SVD  of  the  R  matrix  defined  in  Eq.  (4.104).  Matrix  D 
is  used  for  parameter  estimation  as  shown  in  Eqs.  (4.138)  -  (4.141).  Below  is  an 
example  of  a  matrix  D  obtain  at  a  flight  conditions  20,000  feet  altitude  and  20°  dive 
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angle: 
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Di^i  increases  with  the  slant  range  to  the  ground  object,  which  increases  with  altitude 
and  dive  angle.  So,  in  the  example  above,  the  scaling  problem  is  unavoidable,  and  the 
numerical  results  may  probably  be  inaccurate.  Rescaling  (nondimensionalization)  is 
needed  prior  to  the  application  of  the  SVD  algorithm  to  preclude  numerical  problems 
and  for  a  robust  estimation  algorithm. 

9.  During  the  derivation  of  the  measurement  equations  for  the  aircraft’s  aerodynamic 
angles  a’  and  f3\  we  assumed  that  the  air  mass  is  stationary,  i.e.,  in  the  absence  of 
wind,  ground  speed  =  air  speed.  This  assumption  simplifies  the  equation  derivation. 
The  measurement  situation  can  be  extended  by  including  wind  in  the  algorithm. 
Thus,  use  the  additional  airspeed  and  a  and  (3  measurements  provided  by  the  ADC 
for  wind  estimation. 

10.  In  this  study,  our  estimation  algorithm  hinges  on  a  2-dimensional  measurement  sce¬ 
nario.  In  theory,  it  is  not  different  from  the  3-dimensional  scenario;  however,  it  is  an 
issue  needed  to  be  worked  out. 

11.  We  use  the  MV  estimation  formulation  in  our  work.  Kalman  Filtering  techniques 
may  be  applied  to  the  problem  at  hand.  The  most  significant  advantage  of  Kalman 
Filtering  might  be  the  “tuning”  of  the  filters  for  optimum  estimation.  The  measure¬ 
ment  noise  statistics  we  used  in  this  study  are  chosen  from  the  current  applications’ 
statistics.  If  the  measurement  noises  are  obtained  from  the  empirical  data,  and  the 
filter  tuning  is  possible,  the  estimation  performance  might  be  improved. 
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12.  In  the  estimation  algorithm  using  singular  linear  regression,  we  perform  linearization 
for  slant  range  measurement  inclusion  into  the  linear  regression  formulation.  The 
approximation  used  in  this  linearization  causes  some  errors  in  the  estimation  results. 
While  Scenario  6  includes  the  ground  object’s  coordinates  information  and  the  slant 
range  measurement  to  the  ground  object,  Scenario  5  includes  the  ground  object’s 
coordinates  information  but  not  the  slant  range  information.  Theoretically,  Scenario 
6  should  outperform  Scenario  5.  However,  contrary  to  theory,  in  some  flight  con¬ 
ditions,  Scenario  5  performs  equally  or  even  slightly  better  in  practice.  We  think 
that  the  above  mentioned  approximation  error  is  the  culprit.  Again,  Extended  or 
Non-Linear  Kalman  Filtering,  or  tuning  of  filters  for  the  approximation  errors,  may 
improve  the  estimation  accuracy. 

13.  Finally,  we  investigated  INS  aiding  by  tracking  an  unknown  ground  object  by  using 
optical  measurement  in  detail  and  for  first  time.  What  we  present  in  this  thesis  is  a 
novel  navigation  concept  supported  by  MC  experiments  using  MatLab.  For  a  realistic 
application,  there  is  more  work  to  do.  Laboratory  tests,  performance  evaluations,  and 
flight  tests  are  needed.  Nevertheless,  this  work  is  an  initial  step  for  future  research. 
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Appendix  A,  Optical  Bearing 
Measurements  By  Tracking  An 
Unknown  Landmark 

The  idea  of  INS  aiding  by  using  bearings  measurements  on  unknown  (lunar)  landmarks 
was  first  suggested  in  [7]  space  navigation  research  of  Apollo  Mission.  Different  from  the 
conventional  means  of  obtaining  inertial  measurements,  the  navigational  system  is  obliged 
to  use  the  changes  in  the  tracking  angle  as  the  vehicle  passes  over  a  landmark  which  has 
unknown  coordinates. 

Let’s  assume  that  the  astronaut  is  able  to  lock  onto  an  identifiable  but  unknown 
point  on  the  earth’s  surface.  Figure  A.l  describes  the  measurement  geometry. 


Figure  A.l  Nominal  tracking  sequence. 


Also  assume  that  Hq  is  the  height  of  the  velocity  vector,  ro  is  the  distance  travelled  for 
some  time  r,  and  lvq  is  the  angular  velocity  of  the  vehicle.  In  this  situation,  the  computed 
bearing  measurements  is  given  by: 


cot 


So  -  rpcupr 

Ho 


(A.l) 


The  problem  here  is  to  determine  the  errors:  r(ti),  r(ti),  9{ti),  rouj{ti),  (()(ti),  and  (p{ti)  at 
the  acquisition  point.  The  time  change  of  the  computed  ac  is  compared  with  the  actually 
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measured  am-  The  difference  between  them  can  help  to  determine  the  velocity  error  vector. 
Figure  A. 2  shows  that  the  altitude  error  r(ti)  cannot  be  distinguished  from  the  lack  of 
knowledge  in  the  altitude  of  landmark.  After  time  r,  the  actual  bearing  measurement  is 
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Figure  A. 2  Tracking  with  erroneous  vehicle  or  landmark  altitude. 


5o-rou;or  cot  a(0)(r(ti)  -  AF) 

=  /?„  +  .(*,) -AH  +  H„  +  r{t,)-AH 

where  AH  is  the  altitude  uncertainty  of  the  landmark. 

After  some  time  r  from  the  beginning  of  the  track,  there  may  be  two  possible  ve¬ 
locity  errors:  Horizontal  and  vertical  errors.  Figures  A. 3  and  A. 4  show  these  situations, 
respectively. 
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Figure  A. 3  Tracking  with  an  erroneous  horizontal  velocity. 
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Figure  A. 4  Tracking  with  an  erroneous  vertical  velocity. 


The  equation  of  bearing  measurements  in  the  case  of  tracking  with  erroneous  hori¬ 
zontal  velocity  follows: 
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When  the  tracking  is  performed  with  erroneous  vertical  errors,  bearing  measurements  are 
denoted  as  below: 


So  -  ro^oT 
cot  Oia  —  TJ  ■  \ 

Ho  +  r(ti)T 

Another  error  source  is  the  initial  range  error.  Determination  of  the  velocity  errors  by  Eq. 
(A. 4)  cause  an  angle  between  vehicle’s  assumed  and  actual  path  as  shown  in  Fig.  A. 5. 
But  it  is  impossible  to  distinguish  the  range  error  from  the  velocity  error.  The  bearing 


Figure  A. 5  Tracking  with  an  erroneous  vertical  velocity. 
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measurements  made  along  the  actual  path  are  calculated  as: 


cot 
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Notice  that  all  the  error  terms  in  Eq.  (A. 2)  to  Eq.  (A.5)  are  generally  small,  so  that  linear 
approximation  can  be  applied  as: 
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By  using  this  approximation,  Eq.  (A. 2)  can  be  re-written  as: 


5o  -  roWo'T  ,  rouJot{r{ti)  -  AH) 

cot  aa  ~  - 77 - h 
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Eq.  (A. 3)  becomes: 
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Eq.  (A. 4)  is  approximated  as: 
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Approximation  of  Eq.  (A.5)  yields: 


So-rpuJoT  SoroLVoOih)  rlujle^ti)  2 
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The  first  terms  of  Eq.  (A.6)  through  Eq.  (A.9)  can  be  recognized  as  cot  ac]  replacing  them 
with  cot  ac  and  re-arranging  yields 


cotaa-cotac  ~  -^{roU}o[r{ti)  -  AH]rouj{ti)Ho  -  So[r{ti)  -  rou;o6{ti)])T 


+  "^[^(^1)  “  ro(jJoe{ti)]T^ 
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The  negligible  magnitude  of  rQUj(ti)HQ  allows  this  expression  to  simplify  to 


cotaa-cotoc  ~  j^{rouJo[r{ti)  -  AH]  + So[rou}o0{ti) -r{ti)])T 

+  “  roujo&{ti)]T‘^  (ATI) 

The  projection  of  Figure  AT  can  be  seen  in  a  plane  normal  to  the  assumed  velocity  vector. 
By  doing  so,  one  can  determine  track  errors  in  the  vehicle  trajectory.  For  this  purpose,  the 
unknown  landmark  should  also  be  contained  in  this  plane.  Although  this  measurement 
provides  no  information  about  the  position  error  (p,  Figure  A. 6  shows  that  it  does  provide 
information  about  the  track  velocity  error.  Two  variables  from  the  in  plane  component  of 
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Figure  A. 6  Tracking  with  an  erroneous  track  velocity, 
this  measurement  has  to  be  known  to  obtain  (p: 


1.  The  distance  between  the  landmark  and  the  velocity  vector  (sum  of  them,  not  the 
individual  components). 

2.  The  sum  of  the  vertical  velocity  and  the  range  error. 

These  measurements  can  be  obtained  by  Eq.  (A.  11),  and  the  measurement  geometry  is 
shown  in  Fig.  A. 7.  Considering  the  angle  /3  between  the  assumed  bearing  measurement 
and  the  actual  bearing  measurement,  it  can  be  written  that 


sin/3 


_ (proT _ 

Ho  +  r{ti)  -  AH  +  (r(ti)  -  roWo6'(ti))r 


(A.12) 
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ACTUAL 'VELOCITY  VECIOR 


Figure  A. 7  Tracking  with  an  erroneous  track  velocity,  altitude,  and  horizontal-vertical 
velocity  error. 

[r(ti)  —  ro(jJo6{ti)]  of  the  denominator,  depending  on  the  particular  orbit,  will  be  negligible. 
On  the  other  hand,  from  small  angle  approximation,  sin  f3  =  [3  will  be  valid.  Hence, 

Ho  r{ti)  - 
rot 

Now,  by  using  Eq.  (A. 11)  and  Eq.  (A. 13),  one  can  solve  for  orbital  parameters  even  if  the 
unknown  landmark  measurements  are  used. 

As  explained,  the  unknown  landmark  measurements  provide  information  about  the 
vehicle’s  velocity  vector.  Since  each  measurement  yields  only  one  equation,  it  is  obvious 
that  the  number  of  the  landmarks  to  be  tracked  must  be  equal  to  the  number  of  the 
unknown  parameters  [7]. 


AH) 


(A.13) 
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Appendix  B,  ^^Gaussian’^  Distribution 

of  Angles 

B.l  Univariate  Gaussian  Distribution  of  an  Angle 

The  l-fj  probability  p  is  the  probability  that  a  random  variable’s  realization  is  within 
1-a  of  its  expectation.  The  l-ci  probability  of  a  “Gaussian”  angular  random  variable  is 
calculated  as  follows 

We  use  the  definition  of  the  error  function 

X 

Tfc  f  (B.l) 

0 


Hence 


V^a  J  2 


(B.2) 


Thus,  the  probability  density  function  of  a  “Gaussian”  angular  variable  6  is 


/W  = 


\/2n(. 


-e  ^ 


—  TT  <  9  <  TT 


Hence,  the  l-o"  probability  for  a  Gaussian  angular  variable  is 


P  = 


(B.3) 


(B.4) 
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B-2 


Then 


x^P  =  y^y 


(B.9) 


The  linear  transformation  T  :  y  ^  x  is 


T  =  T'^ 


0 


0  ^ 


A2  J 


(B.IO) 


and 


det{T)  =  A1A2 

=  \det{P)\2 


(B.ll) 

(B.12) 


When  polar  coordinates  are  used,  the  non-linear  transformation  T  : 
specified  by 


p 

yi 

9 

_  y2  _ 

2/1  =  pcosO 
2/2  =  psinO 


(B.13) 


det\T\ 


6p  56 

5y2  §y2 

Sp  56 


(B.14) 

(B.15) 


and  we  calculate 


det\T\ 


cosO 

sinO 


—psinO 

pcosO 


=  P 


(B.16) 
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Since 


- ^ - r  f  f 

27r\det{P)\2  J J 

X 

X  =  {x\dFP~^x  <  1}, 


Using  eq.  (B.12),  we  obtain 


P 


1 


27r|(iet(P)|  2 


--iF 

D  2  ^ 


ydy\det{PW- 


Y 


y  =  {y\ify  <  1} 


Using  eq.  (B.16),  we  calculate 


P 


(B.17) 

(B.18) 


(B.19) 

(B.20) 


(B.21) 

(B.22) 

(B.23) 

(B.24) 


B.3  Bivariate  Angular  “Gaussian”  Distribution 

The  probability  density  function 


1  —Ix'^P 
rrc  2 


fix)  = 


27r|c^et(P)|  2 


Pi 


(B.25) 


where 


1 


Pi  = 


27r|det(P)|  2 


e-2^  ^ 


(B.26) 
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Using  the  linear  transformation  T,  we  obtain 


Pi  =  ^  jj  e--2y^ydy  (B.27) 

y 

where  the  (parallelogram)  Y  is  the  image  under  the  transformation  T  of  the  square 
{(xi,X2)}  =  {— vr  <  xi  <  IT,  — TT  <  X2  <  vt}.  The  vertices  of  the  parallelogram  Y  are 


Uii 

Ul2 

U22 

Y21 


TT 

0 

T 

0 

_!_ 

A2  _ 

_ 

TT 

_!_ 

0 

T 

0 

_!_ 

A2  _ 

-Yu 

-Yi2 


and  we  calculate 


|Yii|2  =  TT^  [  1  1  1 

1 

0 

T 

1 

0 

1 

Ai  J 

1 

=  TT 


p-1 

1 

1  1 

1 

Similarly 


IU12P  =  TT^ 


p-1 

1 

1  -1 

1 

1 

>— 1 

1 _ 

(B.28) 

(B.29) 

(B.30) 

(B.31) 


(B.32) 

(B.33) 


(B.34) 
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let 


p-i 


a  c 
c  b 


Then 


iTiil  =  7r\/  a  +  6  +  2c 
IT12I  =  7r\/a  +  6  -  2c 


Let  p  =  TTy^a  +  6  +  2|c| 
Evidently, 


Pi 


{Y\Y^Y  =  p^} 


<  1 


Hence 


Thus 


Pi  < 


271 


l,-fr 


e  Vdy  = 


Y 


pe 


-^P"dp 


—  -p^  p 

=  —e 

^  0 


=  1-^ 


62 


2P" 


Pi  <  1  - 


g|(a+6+2|c|)7r2 


(B.35) 


(B.36) 

(B.37) 


(B.38) 

(B.39) 


(B.40) 

(B.41) 

(B.42) 


(B.43) 


Hence,  the  1-a  probability  for  a  bivariate  angular  “Gaussian”  variable  satisfies 


P  > 


1  - 


1 

(a+b+2|c|) 


(B.44) 


where  a  +  6  +  2|c|  is  the  sum  of  the  absolute  values  of  the  elements  of  P 


-1 
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B.3.1  Example. 


P  =  a 


2 


1  0 
0  1 


Then 


P  > 


^  }e 

1 _ 1 

e''  O’ 


(B.45) 


(B.46) 


B.4  Probability  of  being  in  1-a  and  Si/E- 


3  + 


We  have  performed  a  MC  simulation  experiment,  and  obtained  the  estimation  errors 

9+  -e 


—  6  and  7^-  —  7,  i  =  1,  2, N;  N  =  1000,  x  = 


7  -7 


.  We  calculate  what  percent¬ 


age  of  these  errors  are  in  the  predicted  l-a  bound:  The  experimentally  obtained  1  —  a  prob¬ 
ability  is  the  ratio  of  the  number  of  times  when  Xi  satisfies  xf  P~^Xi  <  [dimension  of  Xi] 
to  the  total  numbers  of  runs,  N.  The  “Experimental  l-u  Prob.”  entry  into  the  Table  4.2 
gives  these  statistics  for  different  measurement  geometries. 
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Appendix  C.  Linearization  of  The 
Equality  Constraint 

We  have  the  non-linear  equality  constraint 


f{X)  =  0 


where 


X  =  iR,Xo,Yo,Xp,Yp) 


and 


f{R,  Xo,  Yo,  Xp,  Yp)  =  R-  V(Xo  -  XpY  +  (Fq  -  YpY 


Now, 


f{X)  ^  f^X-)+Vf\^.{X-X-) 


so  that 


V/|^_X  ^  /(X)  +  V/|^_X--/(X-) 


i.e., 


Xf\^.X  ^  yf\._x- -f{x-) 


We  calculate 


v/lw  = 


1, 


(Xo--x-)2  +  (y--Yr)2 


-\X--X^,  Y--Y,-,  X^-X-,  Y,--Y-) 
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and 


v/|^_x--/(x-)  =  i?-  +  — 


{X--X^)X^,  {X^-X-)X-,  {¥,--¥-)¥- 

-R-  +  JiX^  -  Xp)^  +  {¥,-  -  yp-)2 


(Xo  -  Xp)2  +  (Fo  -  yp)2  +  (Xp  -  Xo-)(Xo-  -  Xp)  +  {¥f  -  ¥,-){¥,-  -  ¥f) 


V(Xo  -  Xp)2  +  (Xo  -  Yp)2 


=  0 


Hence,  we  obtain  the  linearized  equality  constraint 


0=(^(Xo-Xpr  +  {¥o-¥pr,  (Xp-X^),  {¥f -¥,-),  {X^  -  Xp),  {¥,--¥f) 


R 

Xo 

Yo 

Xp 

Yp 
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